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ABSTRACT 

The   theory,   detailed   outline   of   operating   and 
algorithm   procedures   of   a  continuous  time-invariant, 
linear   control   state   variable    systems   design   and 
analysis   computer   program   is  presented.  The  program, 
SVS,  which  is  based  on  Melsa's  LINCON,  was   modified  to 
demonstrate  Controllability,   Observability,  Bode  Plot, 
Root   locus   plot,    Nyquist    plot,    pole   placement, 
Luenberger   observer   design,   optimal   control  design, 
time  response  plot  and  some  basic  matrix  manipulations. 
Worked  examples   with  the   program  output  are  included. 
Some  options  give  only  numeric  data  output;  others  give 
both   numeric   data   and   high-resolution   graphs.   The 
software,  which  is  fully   interactive,  menu   driven  and 
user  friendly   is  written   in  Turbo  Pascal  to  be  run  on 
the  IBM-PC  microcomputers.    All  options   are  presented 
via  option   menus  and  the  user  will  be  prompted  for  all 
input  parameters. 
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I.  LINEAR  CONTROL  STATE  VARIABLE  SYSTEMS 

(SVS) 

A.  INTRODUCTION  TO  THE  SVS 

SVS  is  software  for  the  IBM-PC  microcomputer  in 
the  analysis  and  design  of  continuous  time,  linear 
control  systems.  These  programs  are  based  on  the  matrix 
mathematics  of  state  variables  and  were  first  developed 
by  Melsa  [Ref.  1]  and  adapted  for  batch  use  at  NPS  by 
Desjardins  [Ref.  2]. 

The  original  intent  of  this  thesis  was  simply  to 
take  Desjardins'  adapted  version  of  Melsa' s  LINCON  and 
modify  it  for  the  Turbo  Pascal  computer  language.  The 
features  of  this  thesis  are: 

-  User-friendly  as  possible 

-  Menu-driven   program.  <Q>quit  key  always  returns  to 
the  SVS  main    menu. 

The  hierarchical  menu  structure  is  three  levels 
deep  at  any  point.  So  the  user,  before  selecting 
his/her  option,  can  get  help  at  every  menu. 

SVS  was  tested  with  several  examples  and  is  now 
available  to  any  user  on  the  Naval  PostGraduate  School 
control  laboratory  PC's  under  the  SVS  directory  name. 

B.  SYSTEM  REQUIREMENTS 

SVS  is  a  large  program  and  requires  at  least  512KB 
of  Memory  to  run.  The  program  will  run  on  any  IBM-PC  or 
compatible  "MS-DOS"  computer  and  requires  a  standard 
IBM  color  Graphics  Adapter  (CGA)  or  IBM  Enhanced 
Graphics  Adapter  (EGA)  card.  It  will  run  on  either 
monochrome  or  color  monitor,  but  all  menus  are 
supported  by  color,  for  that  reason  they  are  easier  to 
work  with  a  color  monitor  if  available.  The  graphics  in 
the  program  are  in  high  resolution  (640  X  200)  mode. 
They   only   appear   in  the  white-on-black.  The  graphics 
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can  be   dumped  to  an  EPSON,  IBM-Graphics,  or  compatible 
printer  by  using  the  Shift  +  PrtSc  key. 

The  program  is  written  in  the  Turbo  Pascal 
Language.  Turbo  Pascal  has  a  64K  data  segment  and  code 
sizes  limitation.  Under  this  restriction,  SVS  is 
compiled  as  five  executable  programs  and  nineteen 
"Chain"  files.  The  main  program  name  is  SVS  in  the  disk 
files.  It  has  extension  .COM.  The  chain  files  have 
extension  . CHN  and  they  are  not  themselves  executable. 


C.   FILES  ON  THE  DISK 

A   complete    list   of    the 
description  of  these  are  below. 


files 


and 


brief 


( 1  )  SVS.COM 

(2)  INPUT.COM 

(3)  MATRIX.COM 

(4)  PL0T.COM 

(5)  CHANGE. CHN 

(6)  P0LYN0M.CHN 

(7)  CONTROL. CHN 
(8)DETERMIN.CHN 

(9)  EIGEN.CHN 

( 1 0)  BODE. CHN 

( 1  1  )TIMEPLOT.CHN 
( 12)0BSER.CHN 

( 13)LUENBERG.CHN 
( 14)0PTIMAL.CHN 


The  executable  main  menu  module  } 

The  input/change  menu  module  } 

The  matrix  mathematics  menu  module) 

The  graphics  menu  module  ) 

Allows  user  to  change  input  data 

values) 

Calculates  characteristic 

polynomial  of  A  matrix   ) 

Calculates  controllability  of  the 

system   ) 

Calculates  determinant  of  the  A 

matrix  ) 

Shows  eigenvalues  of  the  A  matrix  ) 

Gives  Bode  plot  of  the  system  ) 

Gives  time  response  of  the  system) 

Calculates  observability  of  the 

system) 

Design  Luenberger  observer  to 

achieve  a  closed-loop  poles  of  the 

system   ) 

Optimal  control  design  program   ) 


( 15)P0LE.C0M 


( 1 6)SAVE.CHN 

( 17)RETRIEVE.CHN 

( 18)INVERSE.CHN 

( 19)INPUTDAT.CHN 

(20)HELP1 .CHN 

(21  )HELP2.CHN 

(22)HELP3.CHN 

(23)HELP4.CHN 

(24)NYQUIST.CHN 

(25)RL0CI.CHN 
(26)R00TS.CHN 


To  calculate  feedback  coefficients 

to  achieve  a  desired  closed-loop 

poles   > 

Saves  data  to  desired  drive   > 

Gets  data  from  desired  drive   > 

To  calculate  inverse  of  the  A 

matrix   > 

To  permit  user  to  enter  the  input 

data  for  whole  system   > 

Help  program  for  SVS  main  menu 

options } 

Help  information  for  the 

input/change  menu  options   > 

Help  information  for  the  matrix 

mathematics  menu  option   } 

Help  information  for  graphics  menu 

option   > 

to  calculate  Nyquist  (polar)  plot 

of  the  system  ) 

Root  locus  plotting  procedure) 

Shows  plant  characteristic 
equation  roots  ) 


In  addition  to  these  files,  there  are  three 
"system"  files  that  are  needed  to  run  the  program. 
These  are  4X6. FON,  8X8. FON  and  ERROR. MSG  files. 

D.   STARTING  TO  THE  SVS 

This  software  package  has  two  diskettes.  The  first 
step  is  to  get  the  SVS  main  menu  on  your  screen.  All 
you  have  to  do  is  follow  these  steps: 

1 .  Turn  on  the  power  (  or,  if  it's  already  on,  the 
user  reboots  the  computer  ) . 
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2.  Wait  for  the  operating  system  prompt.  It  will 
look  like  one  of  the  following: 

C:_ 

C>_ 

C\>_ 

C:\_ 

C:  \>_ 

<C\>_ 

(or  some  other  letter). 

The  prompt   may  look  somewhat  different,  depending 

on  the  computer  and  how  it  has  been  set  up. 

3.  Type  MD  SVS  and  press  <ENTER>  key.  This  opens   a 
new  directory. 

4.  Type  CD\SVS  and  press  <ENTER>  key.  This  enters 
the  new  directory. 

5.  Insert  disk  #1  into  disk  driver  A: 
Type  Copy  A:*.*  and  press  <ENTER>  key. 

6.  Repeat  step  5  for  disk  #2. 

7.  Type  SVS  and  press  <ENTER>  key. 

Now  the   user  is  in  the  SVS  main  menu  and  ready  to 
work.  Make  a  choice  for  further  step. 


1  1 


II.  INPUT/ CHANGE  MENU 

A.   INTRODUCTION  TO  THE  INPUT/ CHANGE  MENU 

The  first  step,  of  course,  is  to  enter  the  A,  B  and 
C  matrices  into  the  computer  as  a  common  input.  This 
is  the  starting  point  of  the  program.  For  our  case, 
the  general  state  variable  equations  are  represented  by 
the  following  equations. 


x(t)  =  A  x(t)  +  B  u(t) 
y(t)  =  C  x(t)  +  D  u(t) 


m] 


where  A,   B,  C  are  given  matrices  and  D  is  assumed  to 
have  a  zero  elements  for  this  program. 


**»  SVS  MAIN  MENU  »«« 


(I)  Input/Change  Plant  Matrices  Menu 

(G)  Graphics  Menu 

(C)  Controllability 
(0)  Observability 

(L)  Luenberger  Observer  Design 

(D)  Design  of  Optimal  Control 
(P)  Pole  Placement 

(M)  Matrix  Mathematics  Menu 

(H)  Help 

(Q)  Quit  the  Program 

Make  Your  Selection 


Naval  Postgraduate  School 


Ismail   UNLU 


Figure  2.1  The  SVS  main  menu 
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From  the  opening  menu  of  SVS,  shown  in  Figure  2.1, 
we  choose  the  "Input /Change  Plant  Matrices  Menu" 
option  to  bring  us  to  the  Input/Change  menu  shown  in 
Figure   2.2. 


■•«  INPUT  /  CHANGE  MENU  »«* 


(I)  Input  Plant  Matrices 

(C)  Change  Current  Plant  Matrices 

(S)  Save  Plant  Matrices  to  Disk  File 

(L)  Load  Plant  Matrices  From  Disk  File 

(H)  Help 

(Q)  Quit  to  SVS  Main  Menu 

Make  Your  Selection 


Figure  2.2   The  input /change  menu. 


This  input/change  menu  allows  the  user  to  enter 
common  inputs  to  all  programs.  These  common  inputs  are 
the  plant  or  A  matrix,  the  input  or  B  matrix  and  the 
output  or  C  matrix.  The  only  restriction  is  the 
dimensions  of  the  matrix.  It  must  be  no  greater  than 
10.  This  means  that  the  maximum  matrix  size  has  to  be 
10X10.  However,  due  to  a  user  decision,  a  dimension 
size  not  to  exceed  6  is  required.  The  reasoning  behind 
this  was  due,  in  part,  to  the  printer.  Since  the 
output  format  to  the  printer  is  E1 1 ,  this  naturally 
limits  us  to  6  numbers  per  line.   12  format   places  are 
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normally  considered  necessary  for  good  accuracy.  For 
systems  with  order  greater  than  6,  every  row  of  the 
matrix  is  continued  on  the  second  line.  After 
attempting  this,  it  was  decided  the  results  were 
difficult  to  read.  Otherwise  it  is  appropriate  up  to  a 
10th  orcier  system. 

B.   INPUT  PLANT  MATRICES 

This  option  is  used  to  initially  enter  the  A,  B  and 
C  matrices  of  the  state  variable  equations  (2-1)  and 
(2-2).  For  this  option,  select  the  "Input  plant 
matrices"  from  the  input/change  menu.  The  screen  will 
prompt  the  degree  of  the  plant,  which  is  the  dimension 
of  the  A  matrix.  The  maximum  acceptable  degree  is  10. 
Then  it  asks  for  elements  of  the  A  matrix  and  so  forth. 

Matrices  are  entered  one  element  at  a  time 
beginning  with  1,1  and  continuing  across  the  row  of  the 
matrix.  The  next  row  is  then  entered,  and  the  process 
continues  until  all  elements  have  been  entered.  After 
the  matrix  is  entered,  the  complete  matrix  is 
automatically  brought  to  the  screen  for  review  and 
possible  element  changes.  If  a  change  to  the  matrix  is 
desired  the  user  simply  enters  the  row  and  column 
number  to  change  after  every  prompt.  Then  the  program 
asks  for  corresponding  matrix  elements  to  change. 
After  being  prompted,  the  change  is  entered.  A  review 
of  the  matrix  is  again  brought  to  the  screen.  The  user 
is  again  prompted  for  any  more  possible  changes.  This 
procedure  continues  until  all  changes  have  been  done. 
The  same  A  matrix  procedures  are  repeated  for  the  B  and 
C  matrices.  This  input  data  can  be  used  for  the 
options  without  saving  to  disk  file  until  quitting  the 
program . 
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C.   CHANGE  CURRENT  PLANT  MATRICES 

This  option  allows  the  user  to  change  input  data  A, 
B  and  C  matrices  quickly  and  easily.  The  user  can 
change  the  order  and  elements  of  the  matrices  that  were 
previously  entered.  This  powerful  combination 
facilitates  both  input  correction  and  changes, 
especially  for  higher  order  matrices  during  the  design 
process.  First  Figure  2.3  appears  on  the  screen.  The 
user  can  choose  one  matrix  at  a  time  for  correction. 
Then  the  program  gives  the  order  and  elements  of  the 
selected  matrix.   In  the  beginning  the  user  can  enter  a 


■«"  Change  Current  Plant  Matrices  Procedure  ****** 

Which  matrix  do  you  want  to  change  ?   PLANT  (A)  A_ 

INPUT  (B) 
OUTPUT  (C) 


Press  <ESC>  to  change  it!, 

Then  input  your  choice  with  <ENTER>  key 


Figure  2.3   Change  current  plant  matrices  selection. 


correction  to  the  order  of  the  matrix.  Then,  under  the 
new  dimension,  can  make  corrections  on  elements  of  the 
matrix.  The  program  shows  the  corrected  results  on  the 
screen.  At  the  end  of  the  program,  the  user 
automatically  returns  to  the  input/change  menu.  If  the 
user  wants  to  change  more  than  one  matrix,   he/she  must 
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choose  the  "Change  Current  Plant  Matrices"  option  two 
or  more  times.  A  basic  example  for  this  option  is 
illustrated  in  Figure  2.4. 

D.  SAVE  CURRENT  MATRICES  TO  DISK  FILE 

This  procedure  is  used  to  store  plant  matrices  to 
the  hard  disk  or  floppy  disk  file.  First  it  prompts 
drive  C  as  a  saving  drive.  Then  asks  the  user  for  the 
drive  designator  (A  through  E),  and  filename  for  the 
problem  to  be  saved.  Eight  characters  of  a  MS-DOS 
filename  are  allowed;  the  program  gives  a  filename 
extension  of  M.SVS"  to  each  data.  This  extension  is 
used  to  limit  the  disk  search  for  appropriate  files.  A 
drive  and  filename  are  supplied  by  the  program,  which 
opens  the  file  and  stores  the  data.  The  procedure 
stores  the  data  as  a  text  file.  A  text  file  consists 
of  ASCII  characters,  and  is  usually  designed  to  hold 
readable  information  [Ref.  3]. 

E.  LOAD  PLANT  MATRICES  FROM  DISK  FILE 

The  procedure  first  asks  the  data  drive  where  the 
problems  are  stored.  After  this  is  done,  the  program 
calls  another  procedure  called  "Directory"  [Ref.  4]. 
This  procedure  uses  MS-DOS  function,  calls  and  shows 
all  available  data  files  on  the  screen.  The  user  can 
choose  one  of  the  files  by  moving  arrow  keys  with 
<RETURN>  key.  Then  the  program  opens  the  file  and 
reads  it. 

The  directory  displays  only  the  disk  files  with  the 
extension  ".SVS".  This  eliminates  the  possibility  to 
read  other  files. 
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The  A  matrix  is 


0  .  0000E+00 
0  .  0000E+00 
0 . 0000E+00 


1 . 0000E+00 
0 . 0000E+00 
0 . 0000E+00 


0.0000E+00  -1 .5000E+01 


0.0000E+00   0.0000E+00 

1 .0000E+00   0.0000E+00 

0.0000E+00   1.0000E+00 

-2.3000E+01  -9.0000E+00 


The  order  of  the  system  is: 4,  Change  ?  (Y/N) 
The  order  of  the  system  is: 3 


The  A  Matrix  is 


0 . 0000E+00 
0 . 0000E+00 
0 . 0000E+00 


1 . 0000E+00 
0 . 0000E+00 
0.0000E+00 


0 . 0000E+00 
1 .0000E+00 
0.0000E+00 


Do  you  want  to  change  any  element  ?  (Y/N) 
Input  row  to  change  :  1 
Input  column  to  change  :  1 

A( 1 , 1 )=  10 


The  A  Matrix  is 

1 .0000E+01  1 
0.0000E+00  0 
0.0000E+00   0 


0000E+00 
0000E+00 
0000E+00 


0 . 0000E+00 
1 .0000E+00 
0 . 0000E+00 


Do  you  want  to  change  any  element  ?  (Y/N) 


Figure  2.4   Change  current  plant  matrices  example. 
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III.  GRAPHICS  MENU 

A.   INTRODUCTION  TO  THE  GRAPHICS  MENU 

From  the  opening  menu  of  SVS ,  shown  in  Figure  2.1, 
we  choose  the  "  Graphics  Menu  "  option  to  bring  us  the 
Graphics  menu  shown  in  Figure  3.1.  The  Graphics  menu 
contains  five  basic  options.  These  are  the  time 
response  plot,  Nyquist  plot,  Root  locus  plot, 
characteristic  equation  roots  and  Bode  plot.  This  menu 
is  also  supported  with  the  "Load  plant  matrices  from 
disk  file*'  option.  This  selection  allows  the  user  to 
get  data  from  the  disk  file  quickly  instead  of  going 
via  the  SVS  main  menu  route. 


»»«  GRAPHICS  MENU  »** 

(L) 

Load  Plant  Matrices  From  disk  File 

(C) 

Characteristic  Equation  Roots 

(B) 

Bode  Plot 

(N) 

Nyquist  Plot 

(T) 

Time  Response  Plot 

(R) 

Root  Locus  Plot 

(H) 

Help 

(Q) 

Quit  to  SVS  Main  Menu 

Make 

Your  Selection 

Figure  3.1   The  graphics  menu. 

B.   BODE  PLOT 

Bode  plot  analysis  can  be  accomplished  with  the 
Graphics  menu  by  selecting  the  <B>  Bode  plot  option. 
This  selection  brings  Figure  3.2  to  the  screen.    There 
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are  two  selections  for  the  frequency  plot:  the 
open-loop  Bode  plot  and  closed-loop  Bode  plot.  Input 
data  for  this  option  is  entered  with  the  Input/change 
plant  matrices  menu  selection  which  is  explained  in 
Chapter  II.  If  the  user  wants  the  closed-loop  Bode 
plot,  the  program  automatically  calculates  for  the 
negative  unity-feedback  condition. 


»**  Bode  Plotting  Parameters  »»« 


Open  (0)  or  Closed  (C)  Loop  Plot? 

What  is  the  first  frequency 
(Example:  .01,  1,  100,  etc 

How  many  decades  do  you  want  plotted? 


What  is,  the  first  frequency  to  be  plotted?  .1 


Figure  3.2   Bode  plot  parameters  selection. 


The  user  also  must  enter  the  starting  frequency  and 
number  of  decades  for  the  plotting.  The  upper 
frequency  limit  is  calculated  based  on  the  number  of 
decades.  That  is,  if  user  selects  .1  as  the  starting 
frequency  with  4  decades,  then  the  upper  frequency  will 
be  1 000  rad/sec . 

Bode  plot  displays  two  plots  at  the  same  time. 
These  are  plots  of  magnitude  and  phase  versus  radian 
frequency.  Magnitude  is  converted  to  the  decibels  unit 
using  the  relation 

MagnitudedB  =  20  log-]  0(  magnitude  ) 
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and  phase  is  converted  to  degrees  using  the  relation 

Phasedegree  =  (180/>r)  Phase 

Magnitude  calculations  for  the  single  pole  or  zero  can 
be  written  as 

Magnitude  =  [Realpart2  +  (w-Imaginarypart)2  ]1/2 

and  the  phase  calculation  is 

Phase  =  Tan-1 [( w-Imaginarypart )/Realpart] . 

For  the  whole  system,  the  magnitude  and  phase  are 
calculated  for  each  pole  or  zero.  Then  the  final 
magnitude  is 

Magnitudesystem  =  Magnitudezeros/Magnitudepoles 

and  the  phase  is 

PhaseSyS-kem  =  Phasezeros  -  Phasep0^es 

The  plots  of  the  magnitude  and   phase  are   shown  on  the 

same   graph.     Coordinate   values  of  0dB  magnitude  and 

-180°  phase   coincide   in   the   graph.     We   know  from 

control  theory   that  phase   margin  is   read  at  the  zero 

crossover  of  the  magnitude  curve  and  the  gain  margin  is 

read  at   the  -180°  crossover  of  the  phase  curve.   These 

two  values  can  be   read  directly   from  the   graph.   The 

Bode   routine   calculates   the  numbers  required  for  the 

plots.   The  procedure   "plot-Bode"  converts   the  number 

to  a   graphical  display.    Within  the  Bode-plot  routine 

is  a  call  to  the  procedure  "graph-menu".   Graph-menu  is 

called   by   all   procedures   which  produce  a  graph.   It 

provides  a  small  menu  offering  the   user  the   choice  to 
add   a   title   to   the   graph,   print   the  graph  on  the 
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printer,  print  the  number  or   quit   and   return   to  the 
menu . 

If*  the  user  selects  the  title  to  graph  and  it  is 
completed,  the  plot  is  displayed  with  the  title  on  the 
screen.  The  title  block  can  be  moved  by  using  the 
cursor  arrow  keys  and  relocated  anywhere  on  the  screen, 
when  the  title  box  is  moved  where  the  user  wants,  the 
<enter>  key  must  be  pressed.  Then  the  screen  is  frozen 
in  position  and  the  graph  menu  is  recalled  on  the 
screen. 

The  print  numbers  selection  saves  the  current 
graphic  screen  and  permits  the  user  to  print  the 
numbers  used  to  draw  the  graph.  The  numbers  may  be 
printed  on  the  printer  (this  will  use  a  lot  of  paper) 
or  to  a  disk  file.  If  the  disk  option  is  selected,  the 
user  can  scan  that  file  with  a  word  processor  or  by 
using  the  DOS  "type"  command  and  examine  the  points  of 
interest.   This  option  is  illustrated  on  example  3.1. 

EXAMPLE  3 . 1 

The  example  can  be  stated  as  follows:  Given  plant 
transfer  function 


Gp(s)= 


100  (  0.02  S  +  1  ) 


(s  +  1  )  (  .1  s  +  1 )  ( .01  s  +  1 ) 


(3-1) 


was  rearranged  as  a  state  variable  equations. 


x(t)  = 


0         10      0 

0         0       10 

0         0       0      1 

100000  -112000  -12210  -211 


x(t)  + 


0 
0 
0 
1 


u(t) 


y(t)  =    10000000   200000   0    0    x(t) 
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a)  Obtain  the  Bode  diagram  of  the  above  system. 

b)  Mark  the  following  on  the  Bode  diagram,  recording 
the  numerical  values. 

1 )  Gain  crossover  frequency 

2 )  Phase  margin 

3)  Phase  crossover  frequency 

4 )  Gain  margin 

5)  Resonant  frequency. 


Solution: 

Given  data  entered  to  the  program  by  the  selecting 
of  the  "Input  Plant  Matrices"  option  in  the 
input /Change  menu.  Then  the  program  outputs  can  be 
seen  from  the  Figure  3.3  and  Figure  3.4. 


FIEQUOICV   (.fit/ttzi 


Figure  3.3   Open  loop  Bode  plot  for  example  3.1. 
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Figure  3.4   Closed  loop  Bode  plot  for  example  3.1. 


C.   TIME  RESPONSE  PLOT 

It  is  desirable  to  see  the  system's  response  in  the 
time-domain  to  a  typical  input.  Time  response  can  be 
calculated  and  plotted  with  the  SVS  program  as  can  the 
system  input  sinusoid,  ramp,  step  or  impulse.  All 
these  inputs  have  user  selectable  amplitudes.  Figure 
3.5  shows  the  time  response  parameter  screen. 

The  time  response  algorithm  first  converts  the  A,  B 
and  C  matrices  to  the  open  loop  transfer  function,  then 
into  a  discrete-time,  state-space  equivalent.  The 
theory  of  the  time  response  plot  is  not  included  here. 
Users  who  want  more  information  about  the  subject 
should  consult  reference  4,  or  any  other  relevant 
textbooks . 

EXAMPLE  3 . 2 

For  the  given  system  in  example  3.1 ,  obtain  the 
time  response  plot  and  mark  the  following  on  the  time 
response  plot,  recording  the  numerical  values. 
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1  )  Settling  time 

2)  Maximum  overshoot  for  a  step  input. 

Solution: 

The  program  data  has  already  entered  for  the  Bode 
plot.  The  selecting  "Time  response  Plot"  in  the 
graphics  menu  gives  figure  3.6  as  a  problem  solution. 


**»*  Time  Response  Plotting  Parameters  *** 

What  is  your  input  to  the  system?  STEP  (S)   S 

RAMP  (R) 

SINE  WAVE  (W) 

IMPULSE  (  I ) 

What  is  your  input  amplitude?    1 

Input  one  of  these  choices,  Open  (0)  or  Closed  (C)  C 

Input  your  simulation  time  to  the  system  (99max)  1 . 4 


Figure  3.5   Time  response  parameters  screen. 

D.   NYQUIST  PLOT 

This  section  presents  the  Nyquist  plot  option. 
This  selection  gives  open  loop  and  unity-feedback 
closed  loop  Nyquist  plot.  The  program  first  calculates 
open  loop  transfer  function  of  the  plant.  Then  the 
plot  is  obtained  by  calculating  the  magnitudes  and 
phases  angle  of  the  transfer  function  for  a  specified 
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Km 


■Mpt*  1-65 


no 


Figure  3.6   Time  response  plot  for  example  3-2 


number  of  times  with  a  specified  increment  of  w. 
Before  proceeding  to  the  Nyquist  plot,  the  program 
prompts  the  menu  of  Figure  3.7.  This  parameters  screen 
allows  the  user  to  enter  additional  data  for  the 
plotting.  The  graphic  window  size  is  given  100X100 
scale  if  the  user  selects  the  big  picture  option.  The 
select  own  size  option  asks  the  user  to  enter  starting 
frequency,  number  of  decades  and  X,Y  coordinates 
maximum  and  minimum  values  for  the  plot.  After  getting 
the  plot,  the  procedures  are  the  same  as  with  the  Bode 
plot  option.  These  are  make  a  title  to  the  graph, 
printer  output  and  listing  numbers  (which  are  used  to 
generate  a  graph)  either  to  the  printer  or  a  specified 
file  with  a  given  drive  name. 
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MM* 

Nyquist  Plotting  Parameters  *** 

Open  (0)  or 

(C)  Closed  loop  plot?    0 

Graph  window  (B)  or  (S)  Select  your  own  size? 

S 

Input  your 
( Example : 

first  frequency  to  be  plotted? 
.01  ,  1  ,  1 00,  etc.  ) 

.1 

Input  number  of  decades  do  you  want  plotted? 

4 

X -Maximum 

1  00 

X-Minimum 

-1  00 

Y -Maximum 

100 

Y-Minimum 

-100 

Any  changes 

to  these  parameters?  (  Y  /  N  ) 

N 

Press  <F1 > 

to  change  previous  entry 

Figure  3.7   Parameters  selection  for  the  Nyquist  plot. 

EXAMPLE  3.3 

Figure  3.8  shows  the   Nyquist  plot   for  the  example 
3.1  A,  B  and  C  matrices. 


1 
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Figure  3.8   Example  of  the  Nyquist  plot. 
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E.   SOOT  LOCUS  PLOT 

This  option  plots  the  loci  of  the  closed  loop  poles 
of  a  system  with  transfer  function   G(s)  =  K  N(s)/D(s) 
for  varying  gain.   N(s)  and  D(s)  are  polynomials  of  the 
plant  and   the  program   calculates  from   the  given  A,  B 
and  C  matrices. 

The  user  is  prompted  to  enter  the  starting  and 
ending  gain  values,  maximum  and  minimum  X,Y  coordinate 
values  and  to  select  either  positive  or  negative 
feedback.  These  plotting  parameters  are  shown  on 
Figure  3.9.  After  this  input  routine,  the  program 
assumes  unity  feedback  and  calculates  root  locations 
for  varying  gain  and  plots  them. 


*****   Root  Locus 

Plotting  Parameters  ****** 

Input  STARTING  value  for  the  varying  gain 

0 

Input  ENDING  value 

for  the  varying  gain 

10 

X-Minimum 

-100 

X -Maximum 

100 

Y-Minimum 

-100 

Y-Maximum 

100 

Positive  or  Negative  feedback?  (  P  /  N  ) 

N 

Any  changes  to  these  parameters?     N 

Figure  3.9   Parameters  screen  for  the  root  locus 


EXAMPLE  3.4 

Figure  3.10  shows  the  Root  locus  plot  for  the  given 
data  on  the  example  3.1. 
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Figure  3.10   Example  for  the  root  locus  plot. 


F.  CHARACTERISTIC  EQUATION  ROOTS 

This  option  of  the  graphics  menu  allows  the  user  to 
decide  whether  the  system  is  stable  or  unstable  by 
looking  at  the  root  location  of  the  characteristic 
equation.  The  program  gives  again  the  unity-feedback 
closed  loop  characteristic  equation  roots  of  the  plant. 
The  illustrative  program  output  of  the  example  3.1  can 
be  seen  in  Figure  3.11. 

G.  LOAD  PLANT  MATRICES  FROM  DISK  FILE 

This  last  option  of  the  graphics  menu  allows  the 
user  to  get  saved  data  from  disk  file  directly  instead 
of  going  via  to  the  main  menu  and  input/change  menu. 
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»•«  Plant  Characteristic 

Equation  Roots  *** 

ROOTS 

OF  THE  NUMERATOR 

s[1]  = 

-50.00  +j   0.000 

ROOTS 

OF  THE  DENOMINATOR 

s[1]  = 

-132.032  +j  0.000 

s[2]=  -69.170  +j  0.000 

s[3]  = 

-4.899    +j  -32.893 

s[4]  =  -4.899  +j  32.899 

Figure  3.11    Example  of  characteristic  equation 

roots . 
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IV.  SVS  MAIN  MENU 

A.   INTRODUCTION  TO  THE  SVS  MAIN  MENU 

In  this  chapter  six  options  are  presented  which  may 
be  used  for  the  analysis  and  design  of  control  systems. 
These  options  are  supported  by  the  other  options  which 
are  explained  in  Chapter  II  and  III. 

The  observability  option  is  used  to  determine  the 
observability  index  of  the  system.  Another  very 
similar  program,  controllability  is  used  to  determine 
the  controllability  of  the  system.  The  matrix 
mathematics  option  brings  to  the  screen  another  menu 
selections.  This  program  calculates  an  A  matrix 
determinant,  inverse,  characteristic  polynomial  and 
eigenvalues.  The  last  three  options  may  be  used  to 
design  optimal  linear  control  systems.  The  pole 
placement  option  is  useful  in  the  design  of  linear 
control  state  variable  feedback  control  systems.  In 
the  pole  placement  case,  the  control  is  computed  by 
multiplying  by  a  gain  [K] ,  the  difference  between  the 
reference  input  and  a  weighted  (linear)  sum  of  the 
state  variables.  The  Luenberger  observer  design  is 
used  to  design  a  combined  observer-controller  to 
achieve  a  given  desired  closed  loop  transfer  function 
when  some  of  the  states  are  not  accessible. 

Design  of  optimal  control  will  minimize  a  given 
cost  function  which  produces  a  scalar  control .  The 
program  starts  to  work  at  the  terminal  time  and  works 
backwards  in  time. 


B.   CONTROLLABILITY 

This  option  is  used  to  determine  the 
controllability  of  the  linear  time-invariant  system. 
Consider  the  following  continuous-time  system 
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where 


x(t)  =  A  x(t)  +  B  u(t)  (4-1) 

x  =  state  vector 
A  =  plant  matrix 
B  =  input  matrix 
u  =  control  input 


The  system  described  by  the  above  equation  is  said 
to  be  state  controllable  at  a  given  initial  time  if  it 
is  possible  to  construct  an  unconstrained  control 
signal  which  will  transfer  an  initial  state  to  any 
final  state  in  a  finite  time  interval  [Ref.  5]. 

This  requires  an  algebraic  condition  such  that  the 
rank  r(C)  of  the  controllability  condition  matrix 


C  =  [B! AB! . . 


. !An-1B] 


(4-2) 


is  n,  the  order  of  the  system 


EXAMPLE  4 . 1 

Consider  the  matrices  A  and  B, 


A  = 


0 

1 

-1 

1 

0 

1 

0 

1 

-1 

B  = 


1  0 
0  1 
0   0 


Determine  if  [A,  B]  is  a  controllable  pair. 


Solution:  Since  A  is  3x3  and  B  is  3x2,  matrix  C  has  to 
be  3x6.  The  program  checked  the  rank  of  the 
controllability  condition  matrix.    The   result   of  the 
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program   can   be 
controllable . 


seen   in   Figure   4.1,   the  system  is 


CONTROLLABILITY     RESULT 

The 

Plant  matrix  A  is  : 

0 
1 
0 

.  00000E+00   1.00000E+00 

00000E+00   0.00000E+00 

.  00000E+00   1.00000E+00 

-1 .0000E+00 
1  .00000E+00 
-1 .0000E+00 

The 

input  Matrix  B  is  : 

1 
0 
0 

.00000E+00   0.00000E+00 
.00000E+00   1.00000E+00 
.00000E+00   0.00000E+00 

The 

system  is  controllable. 

Figure  4.1   Controllability  program  output. 


C.   OBSERVABILITY 

In  this  section  we  determine  observability  index  of 
the  linear  systems.  Consider  the  unforced  system 
described  by  the  following  equations: 

The  (unforced)  time  invariant  system 


with  the  observation  vector 


x  =  Ax 


y  =  Cx 


(4-3) 
(4-4) 


The  observability  index,  which   is  defined   as  the  rank 
r(0)  of  the  observability  condition  matrix 


0  = 


C 
CA 


CA 


n-1 


(4-5) 


is  n,  the  order  of  the  system 
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The  program  output  for  this  selection  is 
illustrated  in  Figure  4.2  with  the  A  matrix  as  given  on 
example  4.1  and  the  following  C  matrix. 


C  =  [  1   0   0  ] 


(4-6) 


OBSERVABILITY  RESULT 

The 

Plant  matrix  A  is  : 

0 
1 
0 

00000E+00   1.00000E+00 
.00000E+00   0.00000E+00 
.00000E+00   1.00000E+00 

-1 . 0000E+00 
1 .00000E+00 
-1 .0000E+00 

The 

Output  Matrix  C  is  : 

1 

.00000E+00   0.00000E+00 

0.00000E+00 

The 

system  is  observable  with  index  3. 

Figure  4.2   Observability  program  output 


D.   POLE  PLACEMENT 

Any    single-input 
invariant   system   is 
equations : 


single-output 
described    by 


linear ,    time 
the   following 


x(t)  =  A  x(t)  +  B  u(t) 
y(t)  =  C  x(t) 


(4-7) 
(4-8) 


The  plant 
Figure  4.3. 


is  characterized   as  a   block  diagram  in 
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r(t) 


y(t) 
> 


Figure  4.3   Block  diagram  for  the  state  variable 
representation. 


The  closed  loop  nature  of  the  system  of  Figure  4.4 
is  showed  by  the  presence  of  the  controller.  It 
generates  the  control  signal  u  from  the  knowledge  of 
the  state  variables.  So,  we  can  see  that,  except  for 
the  reference  input  [r] ,  the  state  of  the  plant  x  is 
the  only  information  needed  by  the  controller.   The 
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Figure  4.4   General  closed  loop  system  with  state 
variable  feedback. 
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control  input  is  computed  by  the  multiplying  by  a  gain 
K  the  difference  between  the  reference  input  and  a 
weighted  (linear)  sum  of  the  state  variables.  As  a 
mathematical  expression, 


u=  K  [  r  -  (  k 


1X1 


+  kox 


2*2 


+  knxn 


)] 


(4-9) 


where  the  k-^'s  are  referred  to  as  feedback 
coefficients.  The  gain  K  is  referred  to  as  the 
controller  gain.  The  equation  (4-9)  may  be  simplified 
by  making  it  in  the  matrix  notation 


u=  K  [  r  -  kT  x  ] 


(4-10) 


After  all   this  notation,   the  graphical  representation 
of  the  system  configuration  is  shown  in  Figure  4.5. 


Figure  4.5   Linear  state  variable  feedback  system. 

35 


We  could  obtain  the  closed  loop  transfer  function 
Y(s)/R(s)  from  the  state  variables.  Our  approach  is  to 
force  the  system  into  the  configuration  shown  in  Figure 
4.6. 


>0- 


kT  x(s) 


Heq(s) 


Figure  4.6   Closed  loop  block  diagram  representation 


We  can  see  that  Hea(s)  is  given  by 


eq 


kT  x(s) 


Heq(s)= 

4     y(s) 

Since   y(s)=  C  x(s),  this  expression  becomes 

kT  x(s) 
H^(S)=   Cx(s) 


(4-11) 


(4-12) 


Here  it  must  be  pointed  out  that  the  program 
calculates  the  gain  K,  so  zero  steady  state  error 
results  from  a  step  input.  If  the  user  wants  other 
conditions,  he  may  rescale  K  and  kT  appropriately  by 
hand.  For  example,  assume  he  wants  to  desire  to  have 
the  controller  gain,  K  =  K-|  ,  but  the  program  output  shows 
that  K  =  K0  with  the  feedback  coefficients  k-|  ,  k2 ,  k^ . 
The  procedure  is  then  to  modify  the  program  outputs  by 
setting   K  =  K-|  and  setting 
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kT=  _Jb_    [-  ki  ^  k   -j  (4-13) 

This  procedure  does  not  change  Y(s)/R(s)  and  satisfies 
the  condition  K  =  K-|  .  Under  these  notations  and  block 
diagrams,  this  option  gives  an  open  loop  transfer 
function  Y(s)/U(s)  for  the  plant,  the  feedback  transfer 
function  Heq(s),  the  controller  gain  [K]  and  the 
feedback  coefficients  [kT]  to  achieve  the  desired 
closed  loop  characteristic  polynomial. 

The  desired  closed  loop  characteristic  polynomial 
is  the  denominator  of  Y(s)/R(s)  and  must  agree  with  the 
order  of  the  plant.  The  user  can  enter  this  polynomial 
either  in  coefficient  form  or  factored  form.  If  the 
user  wants  to  enter  the  coefficient  form,  the 
coefficient  of  the  highest  degree  term  must  be  unity. 

The  methodology  for  computing  the  result  is:  the 
coefficients  of  the  denominator  polynomial  of 
Y(S)/R(s),  which  is  the  polynomial  desired  by  the  user, 
may  be  adjusted  at  will  by  proper  selection  of  k  and  K. 
The  closed  loop  zeros  are  equal  to  the  open  loop  zeros. 
In  other  words,  linear  state  variable  feedback  has  no 
effect  on  the  zeros  of  Y(s)/R(s).  The  program 
calculates  the  numerator  of  Heq(s)  to  achieve  the 
desired  characteristic  polynomial.  Note  that  the 
complete  Heq(s)  is  calculated  by  taking  the  numerator 
of  Heq(s)  and  dividing  it  by  the  numerator  of 
Y(s)/U(s).  In  the  program  procedures,  the  coefficients 
of  the  characteristic  polynomial  are  computed  by  the 
use  of  the  Principle-Minor  method.  For  the  matrix 
inverse  calculation,  the  program  uses  the 
diagonalization  procedures. 

EXAMPLE  4 . 1 

The   plant   matrices   of   a   third  order  system  are 
given  in  the  following  state  variable  representation: 
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x(t)  = 


•1.0  1.0  0.0 
0.0  0.0  1.0 
0.0    -3.0    0.0 


x(t)  + 


0 
0 
1 


u(t)   (4-14) 


y(t)  -  [  1.0  1.0  0.0]  x(t ) 


(4-15) 


Find  the  feedforward  (controller)  gain  [K]  and  the 
feedback  coefficients  [kT]  required  to  achieve  a  closed 
loop  transfer  function  of 


Y(s) 


2  (s  +  2) 


R(s) 


i5  +  4s2  +  6s  +  4 


(4-16) 


The  program  result  for  this  example  is  presented  in 
Figure  4.7. 


POLE  PLACEMENT 

RESULT 

The 

Plant  matrix  A  is  : 

-1 

.  0000E+00 

1 . 00000E+00   0 

.00000E+00 

0 

,  00000E+00 

0.00000E+00 

1 . 00000E+00 

0 

,  00000E+00 

-3.0000E+00 

0.00000E+00 

The 

Input  matrix  B  is  : 

0 

.  00000E+00 

0 

.  00000E+00 

1 

.  00000E+00 

The 

Output  Matrix  C  is  : 

1 

. 00000E+00 

1 . 00000E+00 

0 . 00000E+00 

Denominator   of  Y(s)/U(s)  - 

Descending  powers  of  S  : 

1 

.0000     1 

.0000     3.0000 

3.0000 

Figure  4.7  Program  output  for  the  pole  placement. 
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The  poles  of  the  Y(s)/U(s)  are: 

REAL  PART 

IMAGINARY  PART 

-1 .0000 

+j       0.0000 

0 . 0000 

+j      -1 .7321 

0  .  0000 

+J"        1 .7321 

Numerator  of  Y(s)/U(s)  -  Descending  powers  of  S  : 

1 . 0000     2 . 0000 

The  zeros   of  the  Y(s)/U(s)  are 

• 
• 

REAL  PART 

IMAGINARY  PART 

-2 .0000 

+j        0.0000 

Desired  closed-loop  Characteristic  polynomial  - 

Descending  powers  of  S  : 

1.0000     4.0000     6.0000 

4 .0000 

The  roots  of  desired  closed-loop  characteristic 

polynomial  are: 

REAL  PART          IMAGINARY  PART 

-2.0000       +3 

0.0000 

-1 .0000       +j 

-1 .0000 

-1 .0000       +j 

1 .0000 

Numerator  of  the  Heq(s)  is  -  De 

scending  powers  of  S  : 

1 .5000     1 .5000     0.5000 

The  roots  of  the  Heq(s)  are  : 

REAL  PART          IMAGINARY  PART 

-0.5000       +j 

-0.2887 

-0.5000       +j 

0.2887 

The  feedback  coefficients  [kT] 

are  : 

0.5000    0 .0000    1  .5000 

The  gain  [K]  is  :   2.0000 

Figure  4.7   Program  output  for  the  pole  placement 
(continued) 

The  results  shown  in  Figure  4.7  specify  that  the 
gain  of  the  controller  [K]  is  2.0  and  the  feedback 
coefficients  are  k-|=0.5,  k2  =  0.0  and  kj  =  1.5. 
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E.   LUENBERGER  OBSERVER  DESIGN 

Consider  a   linear  time  invariant  plant  of  the  form 


x(t )  =  A  x( t )  +  B  u(t ) 
y(t)  =  C  x(t) 


(4-17) 
(4-18) 


Let  a  feedback  control  law  for  equations  (4-17)  and 
(4-18)  will  be 

u(t)  =  K  [  r(t)  -  kT  x(t)]        (4-19) 


PLANT 


r 

CONTROLLER 

u 

x  =  A 
y  =  C 

x  +  B  u 

X 

y 

w 

OBSERVER 

Z 
w 

=  F  z  +  G-|  y  + 
=  qT  y  +  hT  z 

G2  u 

f 

\ 

\ 

Figure  4.8   Luenberger  observer  block  diagram. 


Assume  without  loss  of  generality  that  the  plant  is 
controllable  and  observable.  Since  the  state  of 
equation  (4-17)  is  not  directly  available  to  implement 
equation  (4-19),  an  observer  of  the  form 


z(t)  =  F  z(t)  +  G-,  y(t)  +  G2  u(t) 


(4-20) 


and  replacing  the  true  states  with  estimates  yields 


u(t)=  K  [  r(t)  -  kT  z(t)] 
kTz(t)=  hT  z(t)  +  qT  y(t) 


(4-21  ) 
(4-22) 


will  be  designed.   The  resulting  closed  loop   system  is 
shown  in  Figure  4.8. 
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Where 

x  =  state  vector 

u  =  control  input 

y  =  output 

r  =  system  forcing  input 

z  =  estimated  state  vector 

A  =  plant  matrix 

B  =  input  matrix 

F  =  observer  eigenvalues  matrix 

G-|  and  G2  =  observer  gain  matrices 

K  =  controller  gain 

qT  =  output  feedback  coefficients  matrix 

hT  =  observer  feedback  coefficients  matrix 


mmm   Luenberger  Observer  Design  Parameters  *** 

Input  degree  of  observer  (10  max)   2 

Input  the  desired  feedback  coefficients  in 

Factored  <F>  Form   C 
or  Coefficient  <C>  Form 

Input  observer  characteristic  polynomial  in 

Factored  <F>  Form   C 
or  Coefficient  <C>  Form 


Press  <ESC>  to  change  it!, 

Then  type  your  input  with  <ENTER>  key 


Figure  4.9   Luenberger  observer  design  parameters 


The  user   has  to   enter  the  controller  gain  and  the 
feedback  coefficients  which  can  be  found  by  the   use  of 
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"pole  placement"  option.  The  program  asks  the  observer 
eigenvalues  which  are  represented  by  the  F  matrix  in 
the  program.  The  observer  degree  depends  on  the 
observability  index.  For  example,  if  the  observability 
index  r  is  the  minimum  integer,  then  the  observer  gain 
matrix  [G]  has  order  r.  Simply  the  order  of  the 
observer,  when  the  program  prompted  can  be  entered,  As 
equal  to  or  greater  than  (r-1).  These  input  parameters 
are  shown  in  Figure  4.9. 

EXAMPLE  4.2 

The  example  presented  here  for  the  fourth  degree 
plant  is  taken  from  Desjardin's  [Ref.  2].  The  plant  xs 
represented  by  the  following  equations. 


x(t)  = 


(t) 

=     [    10       20       0       0    ]    x(t) 

0 

1          0         0 

0 

0 
0 

0          1          0 
0         0          1 

x(t)    + 

0 
0 

0 

-15       -23    -9 

1 

(4-23) 


u(t) 


(4-24) 


Solution: 

Stepl 

The  x-|  and  x2  are  the  only  measurable  states  and  we 
want  to  achieve  following  closed  loop  transfer 
function. 


Y(s) 


R(s) 


;4  +  6s3  +  17s2 


+  28s  +20 


(4-25) 
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The  controller  gain  [K]  and  the  feedback 
coefficients  required  are  found,  as  can  be  seen  from 
Figure  4.10  by  the  use  of  the  "Pole  placement"  option 
in  the  same  menu.  Results  shown  in  Figure  4.10 
indicates  that  the  feedback  coefficients  [kT]  are  -3, 
-6,  13,  20  and  the  controller  gain  [K]  equals  unity. 


POLE  PLACEMENT  RESULT 

The  Plant  matrix  A  is  : 

0.00000E+00   1.00000E+00 
0.00000E+00   0.00000E+00 
0.00000E+00   0.00000E+00 
0.00000E+00   -1.5000E+01 

0 . 00000E+00 
1 .00000E+00 
0 . 00000E+00 
-2.3000E+01 

0 . 00000E+00 
0. 00000E+00 
1 . 00000E+00 
-9.0000E+00 

The  Input  matrix  B  is  : 

0 . 00000E+00 
0 . 00000E+00 

0  .  00000E+00 

1  .00000E+00 

The  Output  Matrix  C  is  : 

2.00000E+01   1.00000E+01 

0.00000E+00 

0 . 00000E+00 

Denominator   of  Y(s)/U(s)  - 

Descending  p 

owers  of  S  : 

1.0000     9.0000    23.0000    15.0000 

0 . 0000 

Numerator  of  Y(s)/U(s)  -  Descending  powers  of  S  : 

20  .  0000 

Desired  closed-loop  Characteristic  polynomial  - 

Descending  powers  of  S  : 

1.0000     6.0000    17.0000    28.0000 

20  .  0000 

Numerator  of  the  Heq(s)  is  ■ 

-  Descending 

powers  of  S  : 

-3.0000    -6.0000    13.0000    20.0000 

The  feedback  coefficients  [ 

k  ]  are  : 

20.0000   13.0000   -6.0000 

-3.0000 

The  gain  [  K  ]  is  :   1.0000 

Figure  4.10   Pole  placement  result  for  the  Luenberger 
observer  design. 
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Step2 

The  observability  index  is  determined  using  the 
"Observability"  option  in  the  same  menu.   That  results 
is  shown  in  Figure  4.11. 


OBSERVABILITY  RESULT 


The  Plant  matrix  A  is 


0  .  00000E+00 
0  .  00000E+00 
0 . 00000E+00 
0. 00000E+00 


1 .00000E+00 
0 . 00000E+00 
0.00000E+00 
-1 .5000E+01 


The  Output  Matrix  C  is  : 


i .00000E+00 
0 . 00000E+00 


0  .  00000E+00 
1 .00000E+00 


0 . 00000E+00 
1 .00000E+00 
0 . 00000E+00 
-2.3000E+01 


0 . 00000E+00 
0.00000E+00 


0 . 00000E+00 
0.00000E+00 
1 . 00000E+00 
-9.0000E+00 


0 . 00000E+00 
0 . 00000E+00 


The  system  (A,C)  is  observable  with  index  3. 


Figure  4.11   Observability  result  for  Luenberger . 


Step3 

As   can   be   seen   from  Figure  4.12,  the  system  is 
completely  controllable. 


CONTROLLABILITY     RESULT 

The 

Plant  matrix  A  is  : 

0. 
0. 
0 
0 

00000E+00   1.00000E+00 
00000E+00   0.00000E+00 
00000E+00   0.00000E+00 
00000E+00   -1 .5000E+01 

0.00000E+00 
1 .00000E+00 
0.00000E+00 
-2.3000E+01 

0.00000E+00 
0 . 00000E+00 
1 .00000E+00 
-9 . 0000E+00 

The 

input  Matrix  B  is  : 

0 
0 
0 
1 

. 00000E+00 
. 00000E+00 
. 00000E+00 
. 00000E+00 

The 

system  (A,B)  is  contro 

Liable. 

Figure  4.12   Controllability  output  for   Luenberger 
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Step4 

An   observability   index   r=3   (result  taken   from 

observability  output)  allows  us   to  design  an  observer 

of  order  equal  to  or  greater  than  (r-1)=2.  For  this 


LUENBERGER  OBSERVER  RESULT 

The  plant  matrix  A  is  : 

0.00000E+00   1.00000E+00 
0.00000E+00   0.00000E+00 
0.00000E+00   0.00000E+00 
0.00000E+00   -1.5000E+01 

0.00000E+00   0.00000E+00 
1.00000E+00   0.00000E+00 
0.00000E+00   1.00000E+00 
-2.3000E+01   -9.0000E+00 

The  input  matrix  B  is  : 

0 . 00000E+00 
0 . 00000E+00 
0 . 00000E+00 
1  .00000E+00 

The   output  Matrix  C  is: 

1.00000E+00   0.00000E+00 
0.00000E+00   1.00000E+00 

0.00000E+00   0.00000E+00 
0.00000E+00   0.00000E+00 

The  desired  feedback  coefficients  are  : 

2 . 00000E+01 
1  .30000E+01 
-6  .  0000E+00 
-3 . 0000E+00 

The  Observer  characteristic 
in  ascending  powers  of  S 

2   polynomial  coefficients 

1.40000E+01   7.50000E+00 

1  .00000E+00 

The  F  Matrix  is  : 

-7.5000E+00   1.00000E+00 
-1.4000E+01   0.00000E+00 

The  G1  Matrix  is  : 

8.55000E+01   2.92500E+01 
0.00000E+00   0.00000E+00 

The  G2  Matrix  is  : 

-3 . 0000E+00 
-1 .5000E+00 

The  output  feedback  coefficients  are  : 

2.00000E+01   8.50000E+00 

The  compensator  feedback  coefficients  are  : 

1.00000E+00   0.00000E+00 

Figure  4.13   The  Luenberger  observer  design  output 
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example,   we   want   to   design   observer  eigenvalues  of 
-3.5  and  -4.0. 

Step5 

The  program  results  for  all  this  input  data  is 
shown  in  Figure  4.13.  From  results,  the  complete 
system  can  be  described  as: 


x(t)  = 


0.0 

1  .0 

0.0 

0.0 

x^t) 

0 

0.0 

0.0 

1  .0 

0.0 

x2(t) 

+ 

0 

0.0 

0.0 

0.0 

1  .0 

x3(t) 

0 

0.0 

-15. 

-23. 

-9. 

x4(t) 

1 

u(t) 


z(t)  = 


-7.5 

-1  .0 

z3(t) 

+ 

85.5 

-14. 

0.0 

z4(t) 

0.0 

29.25 
0.0 


x^t) 
x2(t) 


•3.0 

•1  .5 


u(t) 


u(t)  =  1.0  r(t)  -  [  20.0   8.5] 


-  [1.0  .0] 


\jm_ 


\j'M 


F.   DESIGN  OF  OPTIMAL  CONTROL 

The  system  considered  is  described  by  the  following 
state  variable  equation: 


where 


x(t )  =  A  x(t )  +  B  u(t ) 

x  =  state  vector 
u  =  control  input 
A  =  plant  matrix 


(4-26) 
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B  =  input  matrix 

The   design    of   optimal   control   will   minimize   the 
following  cost  function: 

N-1 
J(N)  =  1/2[  XT(N)  Q  X(N)  +  ]^lcx(k)  Q  X(k)  +  R  U2(k)] 

k=0  (4-27) 

where  the  following  are  defined 

Q  =  noise  covariance  matrix 

N  =  time  intervals  over  which  the  SUM  is  made 
R  =  scalar  random  input 
and  XT  means  transpose  of  X. 

The  physical  interpretation  of  J(N)  is  this:  we 
wish  to  keep  the  state  near  zero  without  excessive 
control  energy  expenditure.  The  input  parameters  of  the 
design  of  optimal  control  are  entered  in  the  beginning 
of  the  program.  This  screen  can  be  seen  in  Figure 
4.14.  After  entering  these  parameters  and  the  Q 
matrix,  then  the  program  calculates  the  feedback  gain 
matrix  which,  when  multiplied  by  the  state  vector, 
yields  a  scalar  control.  In  the  program  procedures, 
the  following  equations  were  derived  using  dynamic 
programming,  starting  at  the  terminal  time  and  working 
backwards . 

P(k)=PSIT(k)  *  P(k-1)  *  PSI(k)  +  Q  +  GT(k)  * 

R  *  G(k),  P(0)=0  (4-28) 

PSI(k)=FI  +  GAMMA  *  GT(k),    PSI(0)  =  0  (4-29) 

GT(k)=-[GAMMAT  *  P(k-1)  *  FI]/[GAMMAT  *  P(k-1)  * 

GAMMA  +  R] ,   GT(0)=0    (4-30) 
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******   Design  of  optimal  control  procedure 


MMM 


Input  number  of  time  intervals  for  SUM  procedure?   40 
What  is  your  sample  interval?      0.1 
What  is  the  value  of  scalar  R?     2.0 

For  the  following  options  which  cost  function 

do  you  want?     0 

COST=terminal+fuel+trajectory  or 

COST=terminal+trajectory  <0> 

COST=terminal+fuel  or  COST=terminal   <1> 

where 

terminal  1/2  XT(N)  Q  X(N) 

N-1 
trajectory=  1 /25"~~X(k)  Q  X(k) 

k=0 
N-1 
fuel  =  1  /2  £ZR  U2(k) 
k  =  0 

Press  <ESC>  to  change  it!, 

Then  type  your  input  with  <ENTER>  key 


Figure  4.14   Optimal  control  parameters  screen. 


For    simplicity    in   programming,   the   following 
definitions  are  defined: 


Terminal  1/2  XT(N)  *  Q  *  X(N)  (4-31) 

N-1 
Trajectory=  1/2  ^Z^X(k)  *  Q  *  X(k)       (4-32) 

k  =  0 

N-1 
Fuel  =  1/2  /_R  *  U2(k)  (4-33) 

k  =  0 
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EXAMPLE  4.3 

Given  the  system  equation  and  parameters  described 
below  find  the  discrete  steady  state  gains  for  a  sample 
interval  0.1,  scalar  R  is  1.0  and  number  of  time 
intervals  is  4-0. 


x(t)  = 


0 
5 


1 
0 


x(t)  + 


0 
1 


u(t) 


(4-34) 


The  graphic  result  of  the  program  is  shown  in 
Figure  4.15  and  Figure  4.16,  the  numerical  output  is  in 
the  Figure  4.17. 


-1 

G 
A 

-5D1- 

tie:i3  ekmf-li 

-*D      - 

-5D      - 

•€D      - 

\ 

-7D      - 

\ 

-SD       - 

■ 

1                            1 
5                       14 

1               ""1 

TDJf  DUEWALS:  J° 

1 
25 

1 

30 

Figure  4.15   Optimal  control  graphic  output  #1 


G.   MATRIX  MATHEMATICS  MENU 

This  option  is  used  to  get  various  calculations 
with  the  plant  matrix  A  of  a  given  linear  control  state 
variable  system.   The  selection  from  the  SVS   main  menu 
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brings  the   matrix  mathematics   menu.   This  second  menu 
consist  of  following  options: 

(1)  The  determinant  of  A  matrix 

(2)  The  inverse  of  A  matrix 

(3)  The  characteristic  polynomial  of  A  matrix 

(4)  The  Eigenvalues  of  A  matrix 


Before  selecting  this  option,  the  user  must  select 
"Input /Change  Plant  Matrices"  option  to  enter  the 
plant  matrices. 


-i 

K.30 


-if 


-50  2 

•♦D 
-ED 
-*D 
•70 
-SD 


:-i.   :r  •  j.  ;*. 


TIESIS    EhJtlFUE 


i« 


ririf  m 


rEHJflLJ 


25 


30 


Figure  4.16   Optimal  control  graphic  output  #2 
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OPTIMAL 

CONTROL  RESULT 

The 

order  of  the  system 

is  :  2 

The 

number  of  time  intervals  is  : 1 . 0E- 

01 

The 

scalar  R  is  :  1.0000 

The 

sample  interval  is  : 

40 

The 

A  matrix  is: 

0. 

00000E+00   1.00000E+00 

5. 

00000E+00   0.00000E+00 

The 

B  matrix  is: 

0. 

00000E+00 

1  . 

00000E+00 

The 

Q  matrix  is: 

1  . 

00000E+00   0.00000E+00 

0. 

00000E+00   2.00000E+00 

The 

FI  matrix  is: 

1  . 

02510E+00   1.00835E- 

-01 

5. 

04177E-01   1.02510E+00 

The 

GAMMA  matrix  is: 

5. 

02087E-03 

1  . 

00835E-01 

MINIMIZATION  OVER  ALL  STAGES 

(stages)     GT:2 

GT:2 

1 

-1 .047E-01 

-2.031E-01 

2 

-3.243E-01 

-4.21 1E-01 

3 

-6.722E-01 

-6.665E-01 

4 

-1 . 164E+00 

-9.495E-01 

5 

-1 .809E+00 

-1 .275E+00 

6 

-2.597E+00 

-1 .640E+00 

7 

-3.494E+00 

-2.031E+00 

8 

-4.437E+00 

-2.424E+00 

9 

-5.355E+00 

-2.794E+00 

1  0 

-6. 185E+00 

-3. 120E+00 

1  1 

-6 .888E+00 

-3.390E+00 

12 

-7.452E+00 

-3.603E+00 

13 

-7.886E+00 

-3.765E+00 

14 

-8.210E+00 

-3.883E+00 

15 

-8.447E+00 

-3.969E+00 

16 

-8.617E+00 

-4.030E+00 

17 

-8.738E+00 

-4.073E+00 

18 

-8.824E+00 

-4. 104E+00 

19 

-8.884E+00 

-4. 125E+00 

20 

-8.927E+00 

-4. 140E+00 

21 

-8.957E+00 

-4. 1 50E+00 

22 

-8.978E+00 

-4. 157E+00 

23 

-8.993E+00 

-4. 163E+00 

24 

-9 . 004E+00 

-4. 166E+00 

25 

-9.01 1E+00 

-4. 169E+00 

26 

-9.016E+00 

-4. 170E+00 

27 

-9 . 020E+00 

-4. 172E+00 

28 

-9.023E+00 

-4. 173E+00 

29 

-9.025E+00 

-4. 173E+00 

Figure  4.17   Optimal  control  numerical  output 

51 


V.  CONCLUSION  AND  RECOMMENDATIONS 

The  software,  SVS,  is  written  as  a  teaching 
learning  tool  for  student  use.  It  can  be  a  nice  tool 
for  analysis  and  design  of  linear  control  state 
variable  systems.  The  program  is  fully  interactive  and 
menu  driven.  The  user  does  not  get  lost  in  the 
program.  The  <Q>  key  always  returns  to  the  main  menu 
or  CTRL  +  C  key  interrupts  the  program.  All  options 
were  tested  solving  several  example  problems. 
Hopefully,  all  "bugs"  have  been  eliminated. 

Furthermore,  the  program  can  still  be  easily 
improved  and  expanded.   These  are  listed  below. 

(1)  Adding  the  ability  to  handle  the  KALMAN 
filtering. 

(2)  Add  the  capability   of   the   program   to  handle 
discrete  time  systems. 
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APPENDIX  A 

UTILITI  FILES 

A  set  of  Turbo  Pascal  input  and  menuing  utilities 
was  used  widely  in  the  program.  These  are  public  domain 
utilities  and  was  copied  from  the  LCS-CAD  source 
diskettes.  These  utilities,  called  TURBO-UT . PAS  were 
written  by: 

Donald  R.  Ramsey 

Larry  Romero 

727  Bunker  Hill  #70 

Houston,  Texas   77029 

and    distributed    through    the   public   domain.   The 
describing  documentation  are  presented  on  reference  4. 
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APPENDIX  B 

PROGRAM  LISTING 

Appendix  B  is  a  listing  files  of  the  Turbo  Pascal 
source  code.  These  files  make  up  the  major  modules  of 
the  SVS  program.  In  general,  most  of  the  driver 
programs  and  including  files  are  listed  in  the 
following  pages.  The  source  modules  from  the  Borland 
International  Turbo  Graphix  Toolbox  and  the 
input/output  utility  routines  are  not  listed. 
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FILE:  SVS.PAS         Program  Listing  Page  1 

Program  State  Variable  System( input , output ) ; 

*  ***********************************************    *) 

*  The  following  include  files  contain  procedures   *) 

*  to  handle  graphics  call  from  the  main  procedures*) 

*  of  this  program.  These  include  files  are  a  part  *) 

*  of  Borland  International's  Turbo  Graphix  Toolbox*) 

*  Which  is  a  commercially  available  product.       *) 

*  ***********************************************    *\ 

§1  Typedef .SYS)    (type  &  variable  decleration) 
I  Box. INC)        {draw  the  box  for  the  main  menu) 

*  **********************************************    * 

*  These  are  utility  procedures  and  functions  to   * 

*  help  input.  They  are  public  domain  programs.    * 

*  **********************************************    *\ 

{$1  Ut-Mod01 . INC}    (I/O  procedures) 
($1  Ut-Mod02. INC) 

Procedure  MainMenu; 

var 

I, Tab  :  Integer; 

Helpl File .Input File ,MatrixFile , 
plotf ile , ControlFile , ObserFile , 
LuenbergFile , PoleFile , OptimalFile   :  File: 
Description  :  Str80: 

Okchoices  :  Set  Of  Char; 

procedure  ProgramExit;  _ 

{Displays  warning  about  program  end) 
begin 

Clrscr;  Highvideo;  ,   .   . 

MsgC'Have  you   wanted  ending  the  SVS  program?  (  Y/N  ) 

'  ,10,10); 
LowVideo ; 
Repeat 

i?  not'(Ch  in  C'Y'  'N'])  then  Beep( 900 , 350 ) 
Until  Ch  in  ['Y' , 'N' J ; 
End; 

Procedure  Menultem( pick: char : description: str 80 ; 

color : integer ) : 
{  allows  easy  selection  of  main  menu  colors) 
Begin 


End; 


TextColor (  color ) * 

Write('  ':Tab,'(');  TextColor (white   );  Write(pick); 

Text Col or (color) ;  Writeln( ' ) ' .description) ; 


Begin  {  Main  Menu  ) 
CI r  Scr  * 

TextCoior( lightblue) ;       „  ,   ,  T 

Msg( '    Naval  Postgraduate  School  Ismail 

UNLU  ' ,7,24); 
GoToXY(21  ,4)  ;  TextColor (white ) ; 
Writelnt'    ***    SVS  MAIN  MENU  ***  ')? 

{  show  mam  menu  ) 

Writeln( »  ' ); 

T  ab  •  =  2  3  * 

Menultem( ' I ' , ' Input  /  Change  Plant  Matrix  Menu', red); 

Wt*  i  1*  p  In  * 

Menultem( ' G' , ' Graphics  Menu' , lightgrav) ; 

Menultem( 'C , 'Controllability' , yellow); 

Menultem  '0' , 'Observability' , yellow) ; 

Menultem( 'L' , 'Luenberger  Observer  Design ', yellow) ; 
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FILE:  SVS.PAS         Program  Listing  Page   2 

Menultem( ' D ',' Design  of  Optimal  Control ', yellow) ; 
Menuitem( 'P' , 'Pole  Placement' , yellow); 
Wr iteln ; 

Menultem( 'M' , 'Matrix  Mathematics  Menu ' , lightgray ) ; 
Wr iteln; 

Menultemf 'H ' , 'Help ' . lightmagenta) j 
Menultem( ' Q ' , ' Quit  the  program ', lightmagenta) ; 
Box; 

if  not  (blockl  in  [1..20]  )  then 
OKchoices:=  L'l'.IH'  'Q'j 
else         OKchoices:=[ 'I,f,C4,'0',,D,,,M,,,P,> 

'G' , 'L' , yH' , *Q'] ; 

Repeat       {sets  legal  choices  depending  on  user) 
Option; 

If  not  ( ch  in  okchoices)  then 
Begin 

Text Co lor (red) ; 

If  blockl  <=  0  then 

Begin 

Beep(900,350) ; 

Msg( 'WARNING:  First   INPUT  ,HELP  or  QUIT!', 

1  ,25); 
End; 
End; Text Co lor (white ) ; 
Until  Ch  in  Okchoices; 
Case  Ch  of 
' I' :  Begin 

Assign( InputFile , ' Input . com' ) ; 
Execute! InputFile ) ; 
End; 
'M' :  Begin 

Assign(Matr ixFile , 'Matrix.com' ); 
Execute ( Mat rixFile ) ; 
End: 
'G' :  Begin 

Assign( Plotf ile , 'plot.com' ); 
Execute ( pi otfile ) ; 
End: 
'  C :  Begin 

Assign( ControlFile , ' Control . chn ' ); 
Chain( ControlFile ) ; 
End: 
' 0' :  Begin 

Assign( ObserFile , ' Obser . chn ' ) ; 
Chain(ObserFile ) ; 
End: 
'L' :  Begin 

AssigmLuenbergFile  ,  'Luenberg.  chn'  ); 
Chain(LuenbergFile ) ; 
End: 
'D' :  Begin 

Assign( optimalf ile , ' optimal .chn ' ); 
Chain ( optimalf ile ) ; 
End; 
'H' :  Begin 

Assign(Help1 File ,  'Helpl  .chn'  ); 
Chain(HelplFile) ; 
End: 
'P' :  Begin 

Assign( PoleFile , ' Pole .com' ) ; 
Execute( PoleFile ) ; 
End: 
' Q' :  Begin 

ProeramExit ; 

if  (ch='Y')  or  ( ch  =  'y')  then 
Exit  :=  True; 
End; 
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End:  {case} 
End;  {main  menu) 

*****************************************    *  ) 

Program  Execution  part         *) 
***************************** #>  *********  *    *  \ 

Jegin  {  svs  ) 
ClrScr;    {clear  screen) 
Exit  :=  False  ;{initialize  boolean) 
Repeat 

if  blockl  <>  1  then 
Begin 

Blockl  :=  0; 
End; 

MainMenu;  {  call  main  menu  until  the  user 
want  to  exit) 
Until  Exit=  True: 
Set  Cap  Num( '  ' , 5  ' , '  ' ) ; Say  Cap_Num; 

{set  caps , insert , and  num  lock  off) 
Blockl  :=  0;    {reset  problem) 
End.  {svs} 
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Program  input ( input , output ) ; 

{*  This  program  allows  the  user  to  enter , change , save 
and  retrieve  the  problem  for  the  whole  options  on  the 
other  menues.  *} 

($1  Typedef .SYS)  {comman  type  &  variable  definitions) 

($1  Ut-mod01 . INC)  {I/O  utility  routines) 
{SI  Ut-mod02. INC) 
($1  Ut-mod03. INC) 

{$1  Box. INC)  {draws  menu  box) 

var 

input datf ile , savef ile , retrievef ile , 
changef ile ,help2f ile  :  file; 


Procedure  InputMenu; 
var  i  ,  Tab 

Okchoices 

Finished 


Integer ; 
Set  Of  Char 
Boolean; 


Procedure  Menu It em ( Pick : Char {Description: St r80 : 

Color : Integer ) ; 
{displays  menu  items  in  color  ) 
Begin 

Text Col or ( color  )  ; 

Write  ('  ':tab,'(');  TextColor( white ) :  Write(pick); 
TextColor ( color);  Writeln(')' .Description) ; 
End; 

Begin 

ClrScr:  TextColor (white ) ;  Finished  :=  False; 

GoToXY(20  ,4-1 ;  retriev:  =true; 

WriteP***  INPUT  /  CHANGE  MENU  ***   '); 

for  i  :=  1  to  4  do  writeln( '  ' ); 

Tab  :=  18: 

Menultemi ' I ' , ' Input  Plant  Matrices  ' ,red); 

Menultem( ' C ',' Change  Current  Plant  Matrices ', yellow) ; 

Writeln; 

Menultem( ' S' , ' Save  Plant  Matrices  to  Disk 

File ' .yellow) ; 
Menultem( 'L ' , 'Load  Plant  Matrices  From  Disk 

File' , yellow); 
Writeln; 

Menultem( 'H' , 'Help' . lightmagenta) ; 
Menultem( ' Q ' , ' Quit  to  SVS  Main  Menu  ', lightmagenta) ; 

Box;  TextColor (white) ; 

Set  Cap  num('C','  ','  '  ) ; say  cap  num:  gotoxy( 40 , 22  )  ; 
if  blockl  <>  1  -Ehen  OKchoices  :  =  T  '  I ?  ,  '  L  '  'H^  ,  '  0  '  J  ., 
else  OKchoices  :  =  [  '  I '  ,  ' C '  , 'H '  ,  ' S '  , ' L '  ,  ' 0 ' ] ; 

Repeat  {wait  for  user  to  input  a  keyprees) 
option; 

if  not  ( ch  in  OKchoices)  then 
begin 

beep ( 900 ,350)  : TextColor ( red) ; 
if  blockl  <  >  1  then 

eisg( 'WARNING:  First  INPUT .RETRIEVE , HELP  or 

QUIT!  * ,1 ,25); 
end; 
end; 

TextColor (white) ; 
until  Ch  in  OKchoices; 
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case  ch  of 
' I ' :  begin 

Assign( inputdatf ile , ' inputdat . chn  '  ) ; 
chain( inputdatf ile ) ; 


end; 
' L ' :  begin 


ssign( retrievef ile , ' retrieve . chn ' ); 
Chain ( retrievef ile ) ; 


end, 
' S' :  begin 

Assign( savef ile , 'save. chn' ); 
Chain( savef ile ) ; 
end: 
' C :  Begin 

Assign( changef ile , 'change. chn' ); 
Chain( changef ile ) ; 
End: 
'H' :  Begin 

Assign(help2f ile , 'help2.chn' ); 
Chain(help2file) ; 
End; 
' Q ' :  begin 

Assign( svsFile , ' svs . com' ) ; 
Execute ( svsFile ) ; 


t    end. 
End;  (case) 
end; 


{  Execution  the  input /change  menu   program.  > 

Begin   {main  program) 

drive : = ' C ' ; 

repeat 

InputMenu; 

Until  Finished  =  True; 
End.  (main  program/ 
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Program  input  d.ata(  input ,  output )  ; 

{To  allow   the  user   to  enter  the  A,B,C  matrix  from  the 

this  program) 

label  13; label  10; label  11;  (label  decleration   for  the 

GOTO  statement) 

($1  Typedef . sys)   {comman  variable  declerations ) 

($1  Ut-mod01 . inc )   {I/O  routines) 
{$1  Ut-mod02. inc) 

var  Ans,Cont  :  Char; 

Out  :  Text; 
Stepping, Step , Steps , 

Tempi , Temp2 , i , 3  :  Integer; 

Result  :  Real; 

inputfile  :  file; 

Begin  {input  data) 
1 3:ClrScr ;~Writeln; 
block1:=1:  textcolor (yellow ) ; 
Write( 'Enter  the  degree  of  the  plant:   '); 
Readln( size ) ; 

if   (size  <=  0)  or  (  size  >  10)   then 
begin 

beep(900,350) ;  goto  13; 
end; 

for  steps:=1  to  10  do        (initialize) 
for  stepping  :=  1  to  1 0  do 
A1 A[steps , stepping]  :=  0.0; 

Writeln( 'Enter  the  elements  of  the  A  Matrix  '); 

wr  iteln ; 

for  steps  :=  1  to  size  do 

Begin 

for  stepping  : =  1  to  size  do 
Begin 

write(  'A(  '  .steps, '  ,  '  .stepping,  ' )  =  '  ); 
Readln( A1 A [steps , stepping] ) ; 
End; Writeln; 
End; 
Repeat 

ClrScr;  Writeln; 

Writeln('The  A  Matrix  is  :  ');  writeln; 

for  steps  :=1  to  size  do 

Begin 

for  stepping  : =  1  to  size  do 
Begin 

Write( '   ',  A1A  [steps , stepping] : 1 1 ) ; 
End;  Writeln; 
End:  writeln;   (prompt  to  any  changes) 
WriteC'Do  you  want  to  change  any  element  of); 
write?'  the  Matrix  ?  (  Y  /  N  7  » ) ; 
Read( Kbd, Ans ) ;  writeln;    (allows  user  to  change 

entered  data) 
if  (  Ans   ='Y')  or  (  Ans  ='y')  then 
Begin 

writeC ' Input  the  row  to  change  :  ');  readln(i); 
writeC'InDut  the  column  to  change  :  '); 

readlni 1 ) ; writeln; 
write('A(,i,',',j,')=  '); readln( result ) ; 
A1 A[i , j ] :=result; 
End; 
Until  Ans  in  [ 'N' , 'n'] ; 


0:  ClrScr; writeln: 

user  inputs  B  matrix  elements  from  the  keyboard) 


60 


FILE:  INPUTDAT.PAS    Program  Listing  Page  2 

write(JHow  many  inputs  do  you  have  ?   '); 

size)  then 


readln(ni ) ; writeln; 
if  (  ni  <  1  )  or  (ni  > 


begin 

beep (900, 350) ;goto  10; 
end; 

for  steps  :=  1  to  10  do 
for  stepping: =1  to  10  do 
B  [.steps , stepping]  :=  0.0; 
Writeln( 'Enter  the  elements  of  the  B  Matrix   ' )  ; 
Wr iteln; 

for  steps  : =  1  to  size  do 
Begin 

for  stepping: =1  to  ni  do 
begin 

Write( 'B('  steps, ',' .stepping, ' )  =  '); 
Readln(  B  [  steps , stepping  ]); 
end; wr iteln; 
End;  Writeln; 
Repeat 

ClrScr;  Writeln; 

WritelnC 'The  B  Matrix  is?  ');  writeln; 

for  steps  :=1  to  size  do 

Begin 

for  stepping: =1  to  ni  do 
begin 

write( '   '  ,B[steps , stepping] : 1 1  ) ; 
end;  writeln; 
End;  Writeln; 

Write('Do  you  want  to  change  any  element  of); 
writer  the  B  Matrix  ?  (  Y  /  N  )  '); 
Read(Kbd, Ans ) ; 

writeln;  {allows  user  to  change  B  matrix  element) 
if  (  Ans  =  'Y')  or  (  Ans  ='y')  then 
Begin 

write( ' Input  the  row  to  change  :  ');  readln(i); 

write 

r< 

W] 

BL 

End; 
Until  Ans  in  [ 'N' , 'n'] ; 

11:ClrScr;  Writeln: 

{user  inputs  output  data  from  keyboard) 

write('How  many  outputs  do  you  have  ?     '); 

readln(no):  v 

if  (  no  <  1  )  or  (  no  >  size  )  then 

begin  , 

beep(900,350) ;goto  11; 
end; 
for  steps :=  1  to  1 0  do 

for  stepping: =1  to  1 0  do 
C [steps , stepping] : =0 . 0 ; 
wr  iteln : 

Writeln( 'Enter  the  elements  of  the  C  Matrix   '); 
Writeln; 

for  stepping  :=  1  to  no  do 
Begin 

for  steps  :=1  to  size  do 

begin  .     . 

Write( !C(i, stepping, ',' , steps, ' )  =  '); 
Readln(  C[stepping, steps] ) ; 

end;  writeln; 
End;  writeln; 
Repeat 

ClrScr;  Writeln; 

WritelnC 'The  C  matrix  is  :  ');  writeln; 
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('Input  the  row  to  change  :  ');  re 
_( 'Input  the  column  to  change  :  ' ); 
eadln(i):  writeln; 

rritePBC  f  ,i,  '  ,  '  ,d  »  '  )a    '  )  ;readln(  result ) 
t[i  ,  j]  :=result ; 
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for  stepping  :=  1  to  no  do 
Begin 

for  steps:=1  to  size  do 

begin 

WriteC '   ', C[stepping, steps] : 1 1 ) ; 

end; wr iteln; 
End:  Writeln; 

Write('Do  you  want  to  change  any  element  of); 
write('  the    Q   Matrix  ?  (  Y  /  N  )  '); 
Read(Kbd, Ans ) :  writeln; 
if  (  Ans  =  'Y<)  or  (  Ans  ='y')  then 
Begin 

write( ' Input  the  row  to  chnage  :  ');  readln(i); 

write( 'Input  the  column  to  change  :  '  ); 

readln(i):  writeln; 

writePC(  5  ,  i,  '  ,  »  ,  j  ,  '  )=  '  ) ;  readln(  result ) ; 


readln(i):  writeln;  k 
wr^tePC(5  ,i  '  '  ,j  ,  '  )  =  '); 
C[i i 3  j : =result ; 


End; 
Until  Ans  in  [ 'N' , 'n'] ; 

Assign( inputf ile , 'input.com' ); 

{re-execute  the  input/cnar.ge  menu  program) 
Execute! inputf ile ) ; 
End. { input_data) 
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Program  change  data( input , output ) ; 

(*      If*  ******  ***,  *###****>***##***********##**#*#**  #  * 

*  This  program  allows  the  user  to  change  A,B,  C   * 

*  matrices  and  their  matrix  order.  * 

*  **********************************************    * 

abel    11;label    12; label    14; 
{$1    Typedef .sys)         {comman   type   &  variable    decleration) 
si    Ut-modGM  .inc)      {I/O   utilities    > 


{$1  Ut-mod02.inc 

var  Ans , temp , inputtype 

Stepping, Step , Steps , i , j 
Result 
inputf ile 
result  size 


Char  ; 
Integer ; 
Real ; 
file; 
integer ; 


Begin 

clrscr ;wr iteln;  gotoxy( 1  , 22  ) ; 

invvideo( ' Press  <ESC>  to  change  it!,  '); 

gotoxy( 1  .23) ; 

invvideo( ' Then  input  your  choice  with  <ENTER>  key'); 

gotoxyC 1 ,2 ] j 

text color( lightblue ) ; 

writeln( '      ***  Change  Current  Plant  Matrices 

Procedure  ***>); 
TextColor (yellow) ; 
writeln(  '=  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  ='  ); 

Msg( 'Which  matrix  do  you  want  to  change 
textcolor ( lightmagenta) ; 

msg('  PLANT  (A 

msg(  '  INPUT  (  B 

msg( '  OUTPUT  (C 
repeat  . 

;rue,F1  ,F1  0) ; 


)  then  beep(900,350) ; 


input( 'A' , 'A' ,50, 6. 2. true, F1 , 

temp := copy ( answer , 1 , 1 ); 

if  not  (temp  in  [ *  A* , <B '  , ' C ' ] 

until  temp  in  ['A'.'B'^C']; 
inputtype :=  temp; 

case  inputtype  of 
'A' :begin 

14:ClrScr; 

writeln('The  A  matrix  is  :');writeln; 

for  steps :=1  to  size  do 

begin 

for  stepping: =1  to  size  do 

begin       ,  _  -■       „  * 

write( '       ' , A1 A [steps , stepping] : 1 1 ) ; 
end;writeln; 
end; wr iteln; 

Write('The    order^    of   the    system    is:', 
size , " 


writeC    Change    ?    (Y/N)'); 
repeat, 

read(kbd,ch ) 

T'Y' , 'N 

begin 


?der    o 

until~ch~in~FY'  ,  'N'  ,  »y '  .  'n']  ; 
if    (ch='Y')    or    (ch='y')    then 
begin 

wr  iteln  * 

writef'The  order  of  the  system  is  :'); 
readln(result  size);    .     n    .    „„. 
if  (result_siz"e<  1  )   or  (  result_size>  1  0  ) 
then  begin 

beep(900,350) ;  goto  14; 
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end; 

size : =result_size ; 
end; 
repeat 

clrscr;writeln; 

Writeln('The  A  Matrix  is  :  ');writeln; 

for  steps  :=1  to  size  do 

Begin 

for  stepping  : =  1  to  size  do 
Begin 

Write( '   ' , A1 A [steps , stepping] : 1 1 ) ; 
End;  Writeln; 
End:Writeln; 
Write( 'Do  you  want  to  change  any  element? 

,  (  Y  /  Np  ; 
Read(Kbd, Ans ); writeln: 
if  not  (Ans  in    'N'^n'])   then 
if  (  Ans   ='Y')  or  (  Ans  ='y')  then 
Begin 

write( ' Input  row  to  change  :  '); 

readlm  i  ) ; 

wr ite(  '  Inr>ut    column    to    change    :     '); 

readln(.i);  writeln; 
writef 'A( »,i.  »  .  »  ,j  ,  ?  )='  ); 

readlnLresult ) : 
A1 A[i , j  J : = result ; 
End; 
Until  Ans  in  [ 'N' , 'n'] ; 
end; 
' B ' :begin 

1 1 :ClrScr ; 

wr iteln( ' The  B  matrix  is  :');writeln; 

for  steps:=1  to  size  do 

begin 

for  stepping: =1  to  ni  do 
begin 

write( '   ', B[steps , stepping] : 1 1 ) ; 
end; writeln; 
end: writeln; 
Write('The  number   of  input  is  :  ',ni,'  , 

Change  ?  (Y/N)'); 
repeat  read(kbd.ch) 
until  ch  in  [ ' Y? , 'N ' , • v ' >  'n » ] ; 
if  (ch='Y')  or  (ch='y')  ihen 
begin 

writeln;  {allow  the  user  to  change  number 

of  input) 
writei'The  number  of  input  is:'); 

readln( result  size); 
if  (result  size<1)   or  (result  size>10) 
then  besin 

beep(900,350) ;  goto  11; 
end; 

ni:=result  size; 
end; 
repeat 

clrscr; writeln; 

Writeln('The  B  Matrix  is  :  ');writeln; 

for  steps  :=1  to  size  do 

Begin 

for  stepping  : =  1  to  ni  do 
Begin 

write( '   ', B[steps , stepping] : 1 1 ) ; 
End;  Writeln; 
End; Wr  iteln ; 
{prompt  the  user  for  changes   on  B  matrix) 
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Write('Do  you   w^nt  to  change  any  element 

Read(Kbd, Ans ) jwritein: 

if  not  (Ans  in  T  'N',*n'])   then 

if  (   Ans   =  'Y')  or  (  Ans  =  'y')  then 

Begin 

write( ' Innut  row  to  change  :  '); 

readln( i ) ; 
write(' Input  column  to  change  :  '); 

readln( i ) : 
wr iteln :write(  '  B(  '  ,  i  ,  '  ,  '  ,  j  ,')=')  ', 
readln( result ) ; 
„  B[i ,3] :=result ; 
End; 
Until  Ans  in  ['N','n']; 
end; 
' C ' :begin 

1 2:ClrScr ; 

writeln( 'The  C  matrix  is  :');writeln; 

for  steps :=1  to  no  do 

begin 

for  stepping: =1  to  size  do 
begin 

write( '   ' ,C[steps , stepping] : 1 1 ) ; 
end; wr iteln; 
end;writeln; 
{allow  the  user  to  change  number  of  outputs) 
WriteC'The  number  of  output  is  :   ' ,no,'); 
write!',  Change  ?  (Y/N)'); 
repeat  read(kbd.ch) 

until  ch  in  [ ? Y ' , 'N '  'y ' , 'n ' ] ; 
if  (ch='Y')  or  (ch='y')  then 
begin 

wr iteln; 

write('The  Number  of  Output  is  :'); 

readln( result  size); 

if  (  result_siz"e<  1  )   or  (  result_size>  1  0  ) 

then  begin 

beep(900 ,350) ;  goto  12; 
end; 

no : =result_size ; 
end; 
repeat 

clrscr ;wr iteln; { show  C  matrix  elements) 
Writeln( 'The  C  Matrix  is  :  ');writeln; 
for  steps  :=1  to  no  do 
Begin 

for  stepping  : =  1  to  size  do 
Begin  _ 

Write( '   ' ,C[steps , stepping] : 1 1 ) ; 
End;  Writeln; 
End;Writeln; 
{prompt  the  user  for  changes  on  C  matrix  ) 

Write(  'Do  you   w^-nt  ~t°   change  any  element 

Read(Kbd.Ans) ;writein; 

if  not  (Ans  in  [  'N'  'n'])   then 

if  (  Ans   ='Y')  or  (  Ans  ='y')  then 

Begin 

writeC'lnDut  row  to  change  :  '); 

readln(i); 
writei ' Input  column  to  change  :  ' ); 

readln( j ) : 
wr iteln :write(  ' C(  ',  i  ,',',  j  ,')=')  ; 

ceadln( result ) ; 
C[i  ,  d ] : =result ; 
End; 
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Until  Ans  in  [ 'N' , 'n' ] ; 
end; 
end; 
Assign( inputfile ,' input . com' ) ;   {re-execute  input 

program) 
Execute! inputfile ) ; 
End. {change  > 
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Program  save_data; 

($1  Typedef .SYS) 
($1  Ut-mod01 . INC) 
{$1  Ut-mod02 . inc) 

var 

filename   :  str20; 


blockf ile 
inputfile 


text ; 
integer ; 
-file; 
begin  (save  data) 
clrscr;  HighVideo; 

{let  user  to  change  drive  if  necessary) 
Msg('**  Your  Data  Drive  is     .  Press  <esc>  to  change 

it  !  **  »  , 1 0, 1 1  )  ; 
repeat 

input (  'A' ,copy( drive . 1  , 1  )  , 32 , 1 1  , 2 , true ,F1  ,F1 0  )  ; 
ch:=  copy ( answer . 1 . 1 ) ; 

if  not(ch  in  [ ' A* , ' B » , • C ' , ' D » , ' E ' ] )   then 
beep(350, 150); 
until  ch  in  [ * A' , <B ' , ' C ' , 'D » , ' E ' ] ; 
Drive  :=  concat ( ch ,':' ); 

clrscr;        {prompt  for  filename  to  store  data) 
msg( ' Input  name  of  file  to  save  data  in  File ',1,10); 
writeln:  writeln; 

writeln('***  Your  DATA  disk  must  be  in  drive 
'  Drive  '  ***»)• 

input ( 'A' ,'' ,45, 10,8, true, F1 ,F10) ; 
filename : =  concat (Drive ,copy( answer ,1,8),'. svs ' ) ; 

Assign( Blockf ile , filename ) ;  {Open  file  ) 
rewrite( Blockf ile ) ; 
Writelm  Blockf ile , size ) ; 
Writeln( Blockf ile , nil ; 
Wr iteln( Blockf ile , no ) ; 
for  i:=  1  to  size  do 
for  1 : = 1  to  size  do 

wr it e( blockf ile, A1 A[i , j] ); 
for  i:=1  to  size  do 

for  .-):=  1  to  ni  do    _    _x 
writeln( blockf ile , B[i , j  J ) ; 
for  i:=1  to  no  do 

for  .i:  =  1  to  size  do„ 

wr l te( blockf ile, C[i , j] ) ; 

close( Blockf ile  ) ;   {close  the  file) 
Assign( inputfile , 'input.com' );{ re-execute 

input/change  menu  program) 
Execute ( inputfile) ; 
end. {save  data) 
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Program   retrieve  data; 

{$1  Typedef .SYS)  "(variable  decleratios) 

($1  Ut-mod01 . INC}  {I/O  routines) 
($1  Ut-mod02. INC) 
($1  Ut-mod03. INC) 

{$1  Directry . INC)   {shows  available  data  files) 

var 

readfile       :  text;    {The  text  file  user  will  use) 

filename  :  str20; 

readerror         :  boolean; 

linecounter , i ,i    :  integer:   {  A  counter  for  the 

lines  we  read) 
inputf ile, PlotFile:  file; 

begin    {  procedure  retrieve  data) 
ClrScr ;HighVideo ; 

{  Allow  change  of  disk  drive  if  desired) 
blockl : = 1 ; 

Msg('**  Your  data  drive  is    .  Press  <ESC>   to  change 
it !  ** '  ,10,  1 1  ); 

TD  ^  i^  f^  ^i  -4- 

" Input (  'A'  .copy (drive.  1  , 1  ) , 32 , 1  1  ,2,true,F1  ,F1 0) ; 
Ch:=  copy( answer . 1  .  1  ) ; 

If  notCch  in  [ ' A5 , ? B *  , ' C ' , ' D ' , 'E ' ] )  then 
beep(900,350); 
Until  ch  in  [ ' A? , ' B ', ' C ' , 'D ' , 'E ' ] ; 
Drive:=  concat(ch, ' :  ' ); 

{  Call  directory  to  display  eligible  files) 
Directory! drive, extension , filename , readerror ) ; 
If  not ( readerror )  then 
Begin 

Assign( readfile , filename ) ; 

A    Open  the  file  and  read  contents) 
Reset ( readfile ) ; 

Linecounter : =0 ;  {count  the  lines  ) 

While  not  EOF( readfile )  do 

(The  built-in  function  EOF  returns  true) 
Begin{if  the  end  of  a  file  has  been  reached) 

Linecounter : =linecounter+1 ; {Count  the  next  line) 
Readln( readfile , size ) : 

{  Read  it  into  variable  line  ) 
Readlni readfile ,ni  ) ; 
Readln( readfile , no ) ; 
For  i:=1  to  size  do 
For  1:=  1  to  size  do 

Read(readfile,A1A[i, j] ); 
For  i:=1  to  size  do 
For  1 : =1  to  ni  do 

Readln(readf ile,B[i ,J] ) ; 
For  i : =  1  to  no  do 
For  j:=1  to  size  do 

Read(readfile.C[i , j] ); 
End;  Close( readfile ) ; 
End 
Else 
Begin 

Belay(l500); 

{  Wait  for  directory  error  message  and  continue) 
Window( 1  , 1  ,80,25)  ; 
Clrscr  ; 
End; 

if  not  (retriev)  then 
begin 

Assign(plotf ile, 'Plot.COM' ); 
Executed PlotFile) ; 
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end 

else 

begin 

Assign( input f ile , ' input . com' ) ; { re-execute 

input/change  menu  program) 
Execute( inputf ile ) ; 
end: 
End.  {retrieve  data) 
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Program  Plot: 

{  Program  plot  contains  graphic  programs.  They  are 
written  bv  WOOD  Roy,  Jr.  and  modified  for  this 
program.   } 

{$1  Typedef . SYS) { type  and  variable  decleration  routine) 

($1  Ut-mod01 . INC)     {I/O  routines  ) 
(SI  Ut-mod02. INC) 
{$1  Ut-mod03.INC) 

($1  Box. INC)         {drawing  menu  box  ) 


var 


1,3  :  Integer; 

help4file  ?Retr ievef ile , Nyquistf ile , 

timeplotf lie ,bodef ile , r locif ile , rootsf ile   :  File; 


Procedure  GraphicsMenu; 
var 

i  ,Tab 

Okchoice 

Finished 


Integer ; 
Set  Of  Char 
Boolean; 


Procedure  Menu It em ( Pick : Char ;Descr iption:Str80 ; 
Color : Integer ) ; 
{gives  easy  selection  of  input  menu  colors) 
Begin 

TextColori color  )  :  v 

Write  ('  ):tab,>(');  TextColor (white ) ;  Write(pick); 

Text Co lor ( color);  Writeln(')' .Description ) ; 


End; 
Begin 


IrScr ; Text Col or (white ) ; 
inished  :=  False : GoToXY( 20 , 4 ) ; 
riteln( '   ***  GRAPHICS  MENU  *** 


Finishes 

Writelnf'   ***  GRAPHICS  MENU  ***   '); 

{display  graphics  menu) 
Wr iteln; 
Tab  :  =  1  8  * 
MenuitemT ' L ' , 'Load  Plant  Matrices  From  Disk 

File ' , red) ; 
Writeln; 
Menultem( • C ' ,' Characteristic  Equation  Roots ■ .yellow) ; 

ellow) ; 

Menultem^ 'R' \ ' Root^Locus^Plo^^ .yellow) ; 

wr  iteln  * 

Menultem( ' H ' , ' Help ' . lightmagenta) ; 

Menultem( J Q ' , ' Quit  to  SVS  Main  Menu  '.lightmagenta); 

Text Co lor (green) ; 

Box;  Writeln; 

Text Color( white ) ;  retr iev: =f alse ; 

GoToXY  (40,22); 

repeat  {  read  user  choice  from  keyboard) 

option; 
until  ch  in  [ ' R ' , ' L ' , ' B ' , ' T ' , ' N ' , ' H ' , ' Q ' , ' C ' ] ; 
case  ch  of 
♦R*  -.begin 

assign( r locif ile , 'rloci.chn' ); 
chain ( rlocifile) ; 
end: 
'L' :  Begin 

Assign( retr ievef ile , ' retr ieve . chn ' ); 
Chain ( retr ievef ile ) ; 
end; 
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'T» :  begin 

Assign( timeplotf ile , ' timeplot . chn ' ); 
Chain ( timeplotf ile ) ; 


end, 
'B' :  begin 

Assign( Bodef ile , ' Bode . chn  '  ) ; 
Chain(bodef ile ) ; 
end; 
'N ' :  begin 

Assign(nyquistf ile , 'Nyquist . chn ' ); 
Chain (Nyquist file ) ; 
end: 
'C  :  Begin 

Assign( rootsf ile , 'roots. chn' ); 
Chain ( rootsf ile ) ; 
End: 
»H» :  Begin 

Assign(Help4File, 'Help4.CHN' ); 
Chain(Help4File); 
End: 
'Q* :  begin 

Assign( svsFile , ' svs . com* ) ; 
Execute ( svsFile ) ; 
end; 
End; 
End; 

Begin  {plot} 
drive : = ' C ' ; 

(initialize  drive  selection  for  load  procedure) 
repeat 

GraphicsMenu;  {repeadely  call  graphics  menu  until 

user  selects  to  quit) 
Until  Finished  =  True; 
End.  (plot) 
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{  BODE  PLOT  is  the  driver  program  for  the  Bode 
plotting  routines.  It  simply  invokes  Bode  plot,  when 
finished,  returns  back  to  the  graphics  menu.  ) 

Program  Bode; 


$1  Typedef.sys)   {graphics  routines) 

SI  Graphix.sys) 

HI  Kernel . sys  > 

SI  Windows. sys) 

SI  Polygon. hgh> 

$1  Axis.hgh) 

$1  Ut-mod01.inc  >   (I/O  routines) 

SI  Ut-mod02.inc  > 

$1  Ut-mod03.inc  ) 

$1  GrapMenu. inc )    (graph  options  menu) 

SI  PlotBode . inc )    (Bode  plotting  routine) 

$1  Boxuser.inc) 


type 

ary4   =  array  [1..11J  of  real; 
ary6   =  array  [1..21]  of  integ 


eger  ; 


var 

plotfile   :file; 


($1  Polynom. inc )        (Polynomial  routine) 

{$1  Rootf ind. inc )      (Polynomial  roots  finder  routine) 

($1  Bodeplot . inc )      (Bode  routine) 

begin 

BODEPLOT;    (call  the  Bode  calculation  routine) 


plotfile, ' PL0T.COM' ) ; 

(re-execute  the  graphics  menu  routines) 
Kplotfile); 


AssignCplotfile^PLOT.COM'J;  t 
Execute 
end. 
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Program  time  response: 

label  13;   {label  decleration  for  GOTO  statement) 

$1  Typedef .sys)    {graphics  routines) 
$1  Graphix. sys  ) 

Kernel . sys ) 

Windows . sys ) 

Axis .hgh) 

Polygon. hgh) 

{$1  Ut-mod01 . inc)   {I/O  routines) 
<$i  UT-mod02.inc> 
{$1  Ut-mod03 . inc) 

{$1  GrapMenu. inc)   {graph  option  menu  procedure) 

type 

ary4     =  array  [1..11]  of  real; 
aryb     =  array  [1..11]  of  integer; 

var 

Psi , Phi , A, Atemp  :  aryls; 

temp,  inputtype  :  char; 

Offset , Slope , Tmax , 

RowSum , MaxRowSum , T , 

T1 ,01dMaxRowSum, 

Plot time ,U input , PhiX , 

hold, Ymax, Ymin,T Plot , 

Amplitude,  Freq,y  :  real; 

Factorial , Plotindex, 

Nincr .code , i , 

i j , j , 1 ,m,n,kk,cnpoles , sizezero         :  integer; 

DumpGraph , GoodN umbers , 

ClosedLoop , quit  :  boolean; 

C1  , Xo Id, Xnext , Gamma  :  ary3s; 

GraphArray, Input array  :  plotarray; 

List  :  text; 

numcoef f , dencoef f , cdencoef f  :  ary4 ; 

kk1  :  integer; 

plotfile  :  file; 

{$1  Polynom.inc)   {characteristic  equation  procedure) 
{$1  Boxuser.inc) 

Procedure  Pr intGraphData; 

{this  procedure  dumps  time-response  data  to  printer) 
Begin 

LeaveGraphic ; Clrscr ; 
repeat     ,  . 

Textcolor (white) ;  gotoxy( 20 , 1 0 ) ; 

writelnP   ***  PROGRAM  OUTPUT  OPTIONS  ***   '); 

gotoxy(20 , 1 3  ) ; 

writeln('<P>  Printer  output7  '); 

Textcolor (yellow) ;    gotoxy( 20 , 1 4 ) ; 

writeln( '     Check  Your  Printer!  '); 

Textcolor (white) :    gotoxy( 20 , 1 5  ) ; 

writeln('<F>  List  to  File  name  '); 

gotoxyC ?0 ,16); 

writelnC'     on  the  current  drive  '); 

gotoxy(20,17); 

writeln('<Q>  Quit       t  ,       .      '); 

gotoxy(42, 1 5) ; textcolor (yel low );write( ' "TIME. RES" ' ); 

gotoxy(28,17); 

readikbd.ch ) ;  ,  ,  .  .  .    ,      .       . 

If    (ch=?F')    or    (ch=»f')    or    (ch='P')    or    (ch='p') 


then 
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begin 

if  (ch  =  'F')  or  ( ch  =  »f)  then 
begin 

gotoxy( 24,1 5); text col or ( red) ; 

write( > printing '); 

assign(list, 'Time. RES' ); 

rewrite! list ) ; 
end 
else 
begin 

gotoxyC  24,1 3) j text col or ( red) ; 

write(  !  PRINTING '  )  ; 

assign(list. ' LST : ' ); 

rewr ite( list ) ; 

wriieln(list , '  TIME  RESPONSE  PLOT 

RESULT  ' ) ; 
writeln( list ) : 
writeln(list , *       TIME  (Sec)  Y 


(  output )  R 

( input) ' ) ; 


iteln(list,  ' '  ) ; 

iteln( list ) ; 


vr 

wr 

for  i  :=  1  to  200  do 

writeln(list,'  ', GraphArray [i , 1  J : 1 0 : 5 


GraphArray [i ,2] :  1  2 : 
InputArray [i , 2] : 1 2 : 4 ) ; 


47' 


? 


> 


> 


end; 

until  ch  in  ['Q','q']; 
EnterGraphic ; 
swapscreen: 
close( list ) ; 
end; 

Procedure  Matr ix_Mult (Matr ix1 ,Matr ix2 : aryl s ; 

var  AnswerMatr ix: aryl s ; 
Order : integer ) ; 
var  i,J     :  integer; 

begin 

for  i:=1  to  order  do 
for  j:=1  to  order  do 

AnswerMatrix[i , j J  :=  0; 

{initialize  the  answer  matrix) 

for  i:=  1  to  order  do 
for  j : =  1  to  order  do 
for  L  :=  1  to  order  do 


end; 


r  Jj  :=  l  to  order  do 

AnswerMatr ix[i , j J  :=   AnswerMatr ix[i , i J 
Matrixl [i ,LJ *Matr ix2[L , J J ; 


Procedure  Scalar_Mult (Matr ix1  :  aryls;  scalar  :  real; 

var  AnswerMatr ix: aryl s ; 
Order : integer ) ; 
var  i , j    :  integer ; 

begin 

for  i:=  1  to  order  do 
for  j:=1  to  order  do 

AnswerMatrix[i , J  J : =  AnswerMatr ix[i , j J  *  scalar; 
end; 

Procedure  Matr ix_Vector_Mult (Matr ix1  : aryls; 

Vector  :  ary3s; 
var  AnswerVector : ary3s ; 
order : integer ) ; 
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var  i , j    :  integer ; 

begin 

for  i:=  1  to  order  do 
begin 

hold:=  0; 
for 


end; 
end; 


r  i  :  =  1  to  order  do 

hold:=  hold  +  Matrixl  [i  ,  j  ]  *Vector  [i 

AnswerVector [i] : =  hold; 


Begin 

initgraphic ; leavegraphic ; 

Boxuser ; 

Characteristic  Equation( A1 A, size , Dencoef f ) ; 

{calculating  denominator  coefficient) 

for  i:=1  to  size  do   PSI [i , size] : =B[i , 1 ] ; 

for  jj:=2  to  size  do 

begin 

for  i:=1  to  size  do 
begin 

1  :=size-J3+1  ; 

kk  1  •  =  "i  + 1  * 

PSlti.d J :=Dencoeff [kk1 ]  *  B[i,1]; 

for  li  =  l  to  sizedo  _  _ 

PSl[i,dJ:=  PSl[i,j]  +A1A[i,l]  *  PSl[l,kk1]; 
end; 
end; 

for  i:=1  to  size  do 

{calculating  numerator  coefficients  > 
begin 

Numcoeff [i] : ■  0.0; 

for  j:=1  to  size  do      _  _       _         _ 

Numcoeff LiJ :=  Numcoeff [i]  +  PSI[j,i]  *  C[1,i]; 
end; 

for  i:=1  to  size  do   {calculating  numerator  order  > 
begin 

mt  =size~Hl  — i  * 

if  Numcoeff [m]  <>  0.0  then  goto  13; 
end; 

1 3 : sizezero : =m-1 ; 
Clrscr ; 

TextColor ( lightblue) ; 

writeln( '  ***  Time  Response  Plotting 

Parameters  **♦>); 

TextColor (yellow) ;writeln( '=================='); 

MsgC'What  is  your  input  to  the  system?   STEP  CS) 

Msg(  '  ,RAI$IP  (R) 

Msg( '  SINE  WAVE  1$) 

Msg( '  IMPULSE  ( I ) 

',1,9); 

r6Input( 'A' , 'S' ,50, 6,2. true, F1 ,F10); 
temp  :=  copy( answer , 1 . 1 ) ;        _x 
if  not  (temp  in  [ ' S ?  , ?R *  , ' W  ,  '  I '  ]  )  then 
HBeep(350,150);  n 

until  temp  in  [ ' S ' , ) R ' , * W , i I ' ] ; 

InputType  :=  temp; 

Msg('What  is  your  input  amplitude?  ',1,11); 

Input ( 'N','1',35,11 ,5,true,F1 ,F10); 

val ( answer , Amplitude , code ) ; 
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case  InputType  of 
' R ' :  begin 

Msg( 'What  is  your  DC  value?  ',1,13); 
Input (  'N'  ,  '0'  ,28. 13, 5, true, F1  ,F10) ; 
val ( answer , Offset , code )  ; 
msgC'What  is  your  slope?  ',  1,15); 
Input ( 'N' , ' 1 ' ,23, 15, 5, true, F1 ,F10); 
val ( answer , slope , code ) ; 
end; 
' W ' :  begin 

Msg( 'What  is  your  frequency? 

(rad/secj ' ,1,13); 
Input ( 'N' , ' ' ,35, 13, 5. true, F1 ,F10); 
val( answer ,Freq, code ) ; 
end; 

Msg('Open  (0)  or  Closed  (C)  Loop  Plot  ?  ',1,17); 

r  eiD  e  at 

Input ( 'A' , 'C' ,40, 17, 2, true, F1 ,F10); 


un 


temp  :=  copy ( answer , 1 , 1 ): 

if  not  (tempin  [ ' 0  *  . * C ' J  )  then  beep( 350 , 1 50  ) ; 

til  temp  in  ['0' ,  '  C  '  ]  ; 


if  temp  =  'C'  then  ClosedLoop 

else  ClosedLoop 


=  true 
=  false; 


Msg( ' Input  your   simulation  time  for 


r  ex?  e  at 

Input ( 'N' , ' ' ,55, 20, 5, true, F1 ,F10); 

val (answer .Tmax, code ) ; 

if 
unt 


the  system  (99 
max)1  ,1  ,20)  ; 


■al(  answer .Tmax, code )  ; 

f  Tmax  >  99  then  beep( 350 , 1 50 ) ; 

;il  (Tmax  <=  99)  and  (  Tmax  >  0)  ; 


Boxuser ; 

if  ClosedLoop  then 
begin 

for  i:=1  to  maxorder  do  CDenCoeff[i]  :=  0.0; 

{ initialize  > 
for  i:=1  to  sizeZero  +  1  do  , 
CDenCoeff[ij  :=  Numcoeff[i]  ; 
(C.L..  denominator   equals  the  sum  of  open  loop 


denominator  and   O.L.  numerator 


V 


for  i:=1  to  SIZE  +  1  do       „  ,  „    m 

CDenCoeff[iJ  :=  CDenCoeff[i]  +  Dencoeff [i] ; 
if  size  >  sizezero  then  CNpoles:=  size 

else  CNPoles:=  SizeZero; 
(Nploes  shold  always  be  greater, but  to  be  safe) 

end 

else 

begin 

CNpoles : =Size ; 

for  i:=1  tosize  do      „  _ 
CDenCoef f [i J : =Dencoef f [i] ; 
end; 

{  Calculation  of  new  A  matrix) 

for  i:=  1  to  CNPoles-1  do 
begin 

for  j:=1  to  CNPoles  do 
begin 

if  J  -  i+1  then  A[i,l]:=  1.0 
else  A[i , j J :=  0.0; 
end; 
end; 
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{Calculation  of  new  C  matrix  > 
for  j:=  1  to  CNPoles  do 

A[CNPoles,j]     :=    -CDenCoef f [j ] ; 
end; 

for  i:=  1  to  CNPoles  do 
begin 

if  i  >  SizeZero  +  1  then  Cl[i]:=  0.0 

.^  ^.   „  else  C1[i]:=  NumCoeff [i] ; 

if  SizeZero  =  CNPoles  then 

C1[il  :=  C1[iJ  +   NumCoeff [SizeZero+1 ]* 
A[CNPoles,i] ; 
end; 

{  Selection  of  sampling  time  interval  > 

Nincr  :=  1000; 
T  :=  (Tmax/Nincr ) ; 
Atemp  :=A; 

Psi  :=   A;  {initialize  psi  to  the  value  of  the 
infinite  series  after  the  first) 

Scalar_Mult( Psi ,T/2 , Psi , CNPoles) ; 

for  i:  =  1  to  CNPoles  do  {two  terms  I  +  A*T  /  2!) 

Psi [i  i] : =Psi [i  i   +1.0* 
Factorial  :=  2;   T1  :=  T;  ' Oldmaxrowsum: =  0.0; 
repeat 
begin 

Factorial  :=  Factorial  *  ( i+1 ) ;   T1  :=  T1  *  T; 
Matrix  Mult (A, ATemp , Phi .CNPoles) ; 

{phi  is  used  at  temp) 
ATemp : =  Phi:   {holding  matrix  to  large  array) 
Scalar_Mult(Phi , (T1 /Factorial) , Phi , CNPoles  ); 

for  j:=1  to  CNpoles  do 
begin 

for  m:=  1  to  CNpoles  do 

begin 

Psi[j ,m] :=Psi[j ,m]  +  Phi[J,m]; 

end; 
end; 

Maxrowsum: =  0.0; 
{computes  maxrowsum  as  measure  of  change  in  last) 
for  j  :  =  1  to  CNpoles  do{series  term  to  be  added.) 

begin 

rowsum:=  0.0; 

for  m:=1  to  CNPoles  do 

rowsum:=  rowsum  +  Psi [ j ,m] ;wr iteln; 
if  rowsum  >  maxrowsum  tnen  maxrowsum  :=  rowsum; 

end: 

if  ( abs(maxr owsum-oldmaxrowsum) /maxrowsum ) <  0.001 

then  finished  :=  false 
{quit  when  . 1 ^change )  else  finished  :=  true; 

oldmaxrowsum  :=  maxrowsum; 
end; 
until  Finished: 
Scalar_Multf Psi ,T, Psi , CNPoles) ; 

for    i„T=    1     to'CNPolesJdo 
Phi[i,i]     :=    PhiTi.il    + 
for    i:=    1_to    CNPoles    do 


Matrix~Mult(A,Psi , Phi , CNPoles 
"or  i  T=  1  to  CNPoles  do 

Phi[i,i]  :=  PhiTi,il  +  1.0; 
or  i:=  1  to  CNPoles  do     _ 

Gamma[i]  :=  Psi [i , CNPolesl ; 
{single  input  system  with  B  vector:   ) 
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Plottime 
for  i:=  1 

Ymax  : = 

Boxuser ; 

for  N 

begin 


<   B=£0000...0  1l   (transpose)) 
=  0.0:  Plotlndex  :=  1;   (initialize) 
to  CNPoles  do  Xold[i]:=  0.0; 

{init.  prev.  state) 
0.0;  Ymin  : =  0.0; 


: =  1  to  Nincr  do 
{begin  calculating  next  state  and  y) 


cas 


{compute  input  at  time  Plottime) 
e  Inputtype  of 
S'  :  Uinput  :=  Amplitude; 
'R'  :  Uinput  :=  Plottime  *  slope  +  of f set j 
'I'  :  if  plottime  =  0  then  Uinput  :=  amplitude 

else  Uinput  :=  0.0; 
' W  :  Uinput  :=  Amplitude  *  sin(freq  *  plottime); 

end;  {case) 

Matrix_Vector_Mult( Phi , Xold,XNext ,CNpoles) : 

{compute  new  states) 
for  i:=1_to  CNpolesdo       _  _ 

Xnext[i]:=  Xnext[i]  +  Gamma[i] *Uinput ; 
y :  =  0.0; 
for  i:=  1 


7:=y+Cl[i]  *  XnextTi] 
:=  1.0E07;   {max  y  limit) 


*  Uinput; 


every  5th  point) 

=  Plottime; 

=  plottime; 
=  Uinput; 
1  ; 

Xold  :=  Xnext ; 


to  CNPoles  do 
begin 

if  abs(y)  <  1 .0E07  then 

else  y 
end: 
if  SizeZero  =  CNPoles  then 

y  :=  y  +   NumCoef f [SizeZero+1  ] 
if  y  >  Ymax  then  Ymax:=  y; 
if  y  <  Ymin  then  Ymin:=  y; 
if  N  mod  5=0  then   {plot 
begin 

GraphArray .Plotindex, 1 . 
GraphArray  .Plotindex, 2. 
InputArray .Plotindex,  1 . 
Input Ar ray [Plotindex, 2 
Plotindex  :=  Plotindex  + 
end; 

Plottime  :=  Plottime  +  T; 
end; 
Ymax  : =  1.1  *  Ymax ; 

Initgraphic; 

SelectWindow( 1 ) ; 

drawtext(20,20,  1 
drawtext  (  20,26,  1 
drawtext  20,32, 1 
drawtext( 20 , 38 , 1 
drawtext (20,44,  1 
drawtext (20, 50, 1 

drawtext (250, 1 95 , 1  , 'TIME(sec) '  ) ; 

NiceAxes( 0 , tmax, ymin .ymax, ' ' ) ; 
Selectworld(WorldNdxGlb7;  SelectWindow( WindowNdxGlb ) ; 

DrawPolyson( GraphArray , 1  , -( Plotindex-1  )  , 0 , 0 , 0  )  ; 
NiceAxes( 0 , tmax ,ymin ,ymax, ' • ) ; 

SetLineStyle( 1  )  ;   {dashed  line  for  input  signal) 
on(  Jn-putArray  ,  1  ,  -(  Plotindex-1  )  ,  0  ,  0  ,  0  )  ; 


,  '0' 
,  'U' 

,  'U' 
,'T' 


DrawPol 
SetLine 


;yle(0) ; 
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repeat  until  keypre'ssed; 

quit  :=  false; 

repeat 

Graph_Menu(  'Time-Response'  , DumpGraph . quit )  ; 

(calls  print/title  menu) 

If  DumpGraph  then   Pr intGrapnData; 
until  quit j 
LeaveGraphic ; 

assign(plotf ile , 'plot . com' ) ; 

(re-execution  graphics  menu  program  > 
execute (plot file ) ; 
end. 
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Program  Nyquist; 

label  1;  {label  decleration  for  goto  statement) 


Typedef . sys  > 
Graphix. sys  > 
Kernel . sys  > 
Windows . sys  > 
Polygon. hgh) 
Axis . hgh) 

Ut-mod01 . inc 
Ut-mod02 . inc 
Ut-mod03 . inc 

$1  GrapMenu.inc 
SI  Plotnyqs.inc 
$1  Boxuser.inc) 


{graphics  routines) 


type 


ary4 
ary6 


=  ar  r  ay 
=  ar  r  ay 


I  Polynom.inc) 
I  Rootf ind. inc ) 


{I/O  routines) 


{graph  options  menu) 
{Nyquist  plotting  routine) 


[1  .  .1 1]  of  real; 

[1  .  .21  J  of  integer ; 

{Polynomial  routine} 
{Polynomial  roots  finde 


r  routine) 


var 

Code  .  I ,  Count.NumberDecad.es  , 

Star xDecade , EndDecade , one 

Wf ,Wo,Wi , Del taW, Gain 

PlotArrayl ,PlotArray2, 

MagPhaseArray .FreqArray 

ZMagn , Z Phase , PMagn , PPhase , Phase 

TempX,TempY 

temp 

OpenLoop ,  PicBig 

i,J3 ,kk1 ,m,l, size zeros, CNpoles 

lencoeff , Numcoef f , cdencoef f 


integer ; 
Real ; 

PlotArray ; 
real ; 
real ; 
char  ; 
boolean; 


integer ; 

ary4; 
realpartpole , imagpartpole ,realpartzero, 
crealpartpole , imagpartzero , cimagpartpole :  ary3s ; 
PSI  :  aryls; 

plotfile  :file; 

function  Log( X : real ): real ; 

{computes  the  base-10  logarithm  of  X ) 
Begin 

If  X=0  then  Log:=0  else 

Log  :=  Ln(X)/Ln( 10); 
End; 


function  Expon( Y , X : real ): real ; 

{computes  Y 
Begin 

Expon  :^  exp(  X  *  (ln(Y))); 
end; 


raised  to  X  power) 


begin 

Boxuser ;  one : = 1 ; 

Characteristic  equation( A1 A, size , Dencoef f ) ; 

for  i:  =  1  to  siz~e  do  , 

PSl[i ,sizej :=B[i , 1 ] ; 
for  Jj:=2  to  size  do 
begin 

for  i:=1  to  size  do 
begin 

1  :=size-jj+1  ; 

kk  1  *  =  ~\  + 1  * 

PSl[i, j J :=Dencoeff [kk1 ]  *  B[i,l]; 
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for  1:=1  to  size  do 

fsi[i,;j]  :=PSI[i,j]  +A1A[i,l]  *  PSI[l,kkl]; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

Numcoeff [i] : =0  .  0  ; 
for  j:  =  1  to  size  do 
begin      ..  , 

Numcoeff [i] :=  Numcoeff [i]  +  PSI[j,i]  *  C  [  1  ,  3  ]  ; 
end; 
end; 

for  i:=1  to  size  do 
begin 

jjjj  =  si  Z6  +  1  i  * 

if  Numcoeff [m]  <>  0.0  then  goto  1; 
end; 

1 : sizezer os : =m-1 ; 
Clrscr  * 

TextCoior ( lightblue ) ; 

writeln( '  ***  Nyquist   Plotting  Parameters 

***'  )  ; TextCoior (yellow) ; 

writeln( '=========================================' ); 

PicBig:=  false; 

Msg('Open  (0)  or  (C)  Closed  Loop  Plot  ?',5,5); 

repeat 

Input ( 'A'  ,  '  ' ,45, 5, 2. true, F1 ,F10); 

temp : =copy( answer ,1 , 1 ): 

if  not(temppin  ['0'  'C?])  then  Beep( 950 , 350 ) ; 


until  temp  "inr  [  '  0  '  ",  '  C*  ]  ; 
if  temp  =  '0'  then  OpenL 


oop  : =  true 
else  OpenLoop  :=  false; 

Msg(  ' Graph  window   (B)  Big  or  (S)  Select  your  own 

size? ' ,5,7); 
repeat  , 

input ( 'A' , ' » ,60,7,2,true,F1 ,F10) : 
{sets  flag  OpenLoop  if  user  selects  the  open  loop) 
temp  :=  copy ( answer , 1 ,1  J : 

if  not(temp  in  L,B,l'S,j)  then  beep( 350 , 1 50  ) ; 
until  temp  in  [ » B y     ' S } ] ; 
if  (temp  =  'B'  )   then  PicBig  :=  true 

else  PicBig  :=  false; 

if  not  (picbig)  then 
begin 

Msg( ' Input  your   first  frequency  to  be 
,    ,  plotted?'  5,9);  \ 

Msg(  ' (example:  .01,  1,  100,  etc . ) '  , 1 0 , 1 0  ) ; 

InputC 'N' , ' ' ,50,9,8,truefF1 ,F10) j 

Val( answer ,Wo , code ); {Wo  is  the  first  plotted  freq) 

Msg( ' Input  number  of  decades  do  you  want 

plotted?' ,5,12); 

Input ( 'N' , ' ' ,50, 12, 2, true, F1 ,F10); 

Val ( answer , NumberDecades , code ) ; 
end 
else 
begin 

wo: =0 . 001 ; 

NumberDecades : =8 ; 
end; 
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root_f inder ( sizezeros ,Numcoeff ,realpartzero, 

imagpartzero .one ) : 
root_f inder ( size ,Dencoeff , realpartpole , 
imagpartpole , one ) ; 

fain : =Numcoef f [sizezeros+1  ] ; 
or  i:=1  to  sizezeros+1  do 
begin 

Numcoef f [i] : =  Numcoef f [i] /gain ; 
end; 
clrscr ; Boxuser ; 

for  i:=1  to  maxorder  do  CDenCoeff[i]  :=  0.0; 

{ initialize  > 
for  i:=1  toSizeZeros  +  1  do 

CDenCoeff[i]  :=  Numcoef f[il  *  gain; 
{C.L.  denominator  equals  the  sum  of  open  loop 
denominator  and  O.L  numerator) 

for  i:=1  to  Size  +  1  do  „  _  _  _ 

CDenCoeff[i]  :=  CDenCoeff[i]  +Dencoef f [i] ; 

if  Size  >  SizeZeros  then  Cnpoles : =Size 

else  CNPOLES: =SizeZeros; 


(compute  new  denominator  roots) 
, CDenCoef f , CRealPartPole , 


root_f inder ( Cnpoles , CDenCoef f . C 
CImagPart Pole , one ) ; 

StartDecade  :=  trunc(Log( Wo ) ) ; 

{compute  linear  scale  to  plot  ) 
EndDecade  :=  StartDecade  +  NumberDecades ; 

{log  numbers.  Also  figure  step) 
Wf  :=  Wo  *  ExponC  1  0  .  0  ,  Number  Dec  ad.es  )  '* 
DeltaW  :=  Expon( ( Wf /Wo ) , 0 . 01 25 ) ; 
Wi  : ■  Wo ; 

for  Count  :=  1  to  81  do 

(do  81  iterations .. .arbitrary  #) 
Begin 

if  OpenLoop  then 
{compute  bode  numbers  if  openloop  and  later  if 
closed  loop  ) 

begin 

ZMagn :=1.0;  ZPhase:=0.0; 
PMagn:=1.0;  PPhase:=0.0;   (initialize) 
for  i  : =  1  to  SizeZeros  do 
(compute  magn  and  phase  of  zeros  for  freq  step) 
begin  _  _ 

ZMagn: = ZMagn  *  Sqrt ( Sqr ( RealPartZero [I] )+„ 

r%   Sqr(Wi-ImagPartZero[l] )); 
if  RealPartZero[I]  =  0.0  then 

ZPhase : =ZPhase+pi/2 . 0  else 
begin 

if  realpartzero[i J  >  0.0  then 

ZPhase:=  ZPhase  -  pi^+  ArcTan((Wi-    „    m 

ImagPartZeroti] )/( -RealPartZero [i] ) ) 

else 

ZPhase : =ZPhase+  ArcTan((Wi-         .  _ 

ImagPartZeroLiJ )/( -RealPartZero [i] ) ) ; 
end; 
end; 

for  i  :=  1  to  Size  do 
{compute  magn  and  phase  of  poles  for  freq  step) 
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begin 


PMagn : = PMagn  *  Sqrt ( Sqr ( RealPartPole [ I] )  + 
!JB>   „  r  -   Sqr(Wi-ImagPartPole[l] ) ) ; 

if  RealPartPole[i]  =  0.0  then 

PPhase:=  PPhase+pi/2 . 0  else 
begin 

if  RealPartPole[i]  >  0.0  then 

PPhase : =PPhase  -  pi  +  ArcTan((Wi-  „ 
ImagPartPole[i] )/( -RealPartPole [I] ) ) 
else 


end; 
end; 


PPhase :=  PPhase+ArcTan( ( Wi- 

ImagPartPoleli] )/( -RealPartPole [i] ) ) ; 


Phase  :=  Frac((ZPhase  -  PPhase )/( 2*pi ) )  *  (2*pi); 

TempX 

TempY 

if  (PicBig)  and  ( TempXw>  '  1 00 )  then  TempX  :='100; 

if  (PicBig)  and  (TempY  >  100)  then  TempY  :=  100; 

then 
1  e  nm  X  * 
If  ((Phase>pi)  and  ( Phase< ( 2*piJ7y~ then" 

TempY  :=  -TempY; 


If  Phase<0  then  Phase : =  Phase+( 2*pi ) ; 
If  ( (Phase>(pi/2) )  and  ( Phase< (3*pi/2 ) ) )  then 

TempX :=  -TempX; 


MagPhaseArray  f  count ,  2]  :=  Phase; 
PlotArray2 [count \ 1 ]  :=  TempX; 


MagPhaseArray [count , 1  J   :=  Gain*ZMagn/Pmagn; 
PlotArrayl  [Count , 1  J  :=  TempX; 


!  ay [count 
Count , 1  J 
count , 1  J 

PlotArrayl [Count ,2]  :=  TempY; 
PlotArray2 [count , 2]  :=  -TempY; 

FreqArray [Count , 1 ]  :=  wi ; 

Wi  : =  Wi  *  DeltaW;  {increment  freq  step) 

end 

else 
{perform  same  steps  as  above  if  closed  loop  requested) 

begin 

ZMagn:=1 . 0 ; Z Phase : =0 . 0 ; PMagn := 1 . 0 ; PPhase : =0 . 0 ; 
for  i  : =  1  to  SizeZeros  do 

begin  ,  _  _ . 

ZMagn:=ZMagn  *  Sqrt ( Sqr ( RealPartZero [ llhf , 

,.  \,Sqr  (Wi-ImagPartZero[IJ  )  ) ; 
if  RealPartZero[l]  =,0.0  then 
ZPhase: =ZPhase+pi/2 . 0  else 
begin  _  _ 

if  RealPartZero[I]  >  0.0  then  tt 
ZPhase : =ZPhase  -  pi^+  ArcTan( ( Wi- 

ImagPartZero[i] )/( -RealPartZero [i] ) ) 
else 

ZPhase  :  =ZPhase+ArcTan(/( Wi-  _  _  x  x 

ImagPartZero[i] )/ ( -RealPartZero[i J ) ) ; 
end; 
end; 

f or  i  : =  1  to  CNpoles  do 

ef Magn := PMagn  *    Sqrt ( Sqr ( CRealPartPole III )+ 

Sgrfwi-CImagPartPole[IJ )); 
if  CRealPartPole[I]  =0.0  then 
PPhase : =PPhase+pi/2 . 0   else 
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begin  _  _ 

if  CRealPartPole[l]  >  0.0  then 

PPhase : =PPhase     pi  +  ArcTan((Wi- 
CImagPartPole[ijT7( -CRealPartPoleTiJ )  ) 


else 


PPhase : =PPhase+ArcTan( (Wi-  r  „ 

CImagPart Pole [i J )/(-CReal Part Pole [i] ) ) ; 

end; 
end; 

Phase    :=    Frac((ZPhase    -    PPhase )/( 2*pi ) )    *    (2*pi); 

(Phase  "modulo"  2Pi> 
TempX  :=  abs( ( Gain* ZMagn/PMagn ) *cos  Phase) } ; 
TempY  :=  abs( ( Gain*ZMagn/PMasn ) *sin{ Phase )) ; 


if  (PicBig)  and  (TempX  >  100)  then  TempX  :=  100; 
if  (PicBig)  and  (TempY  >  100)  then  TempY  :=  100; 

If  Phase<0  then  Phase : =  Phase+( 2*pi ) : 

If  ( (Phase>(pi/2) )  and  ( Phase< ( 3*pi/2  )  )  )  then 

TempX :=  -Temp^ ; 
If  ((Phase>pi)  and  ( Phase<2*pi ) )  then 

TempY  :=  -TempY; 

PlotArrayl [Count , 1 1  :=  TempX; 
Plotarray2 [count , 1 ]  :=  TempX; 

PlotArrayl [Count ,2]  :=  TempY; 
PlotArray2 [count ,2]  :=  -1.0  *  TempY; 

Wi  :=  Wi  *  DeltaW; 
end; 
Plot_Nyquist ( StartDecade .EndDecade , 

NumberDecades .FreqArray , PlotArrayl . 
Plot array 2 ,MagPhase Array , PicBig, OpenLoop  )  ; 

Assign(Plotfile, 'Plot .COM' ) ; 
Execute (plotfile ) ; 

end.  (Nyquist) 
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Program  Root_Locus; 

{  This  program  plots  the  root  locus  of  the  plant  > 

label  1; {label  dec ler at ions  for  the  goto  statement) 

$1  Typedef . sys)   {graphics  routines) 
Graphix. sys ) 
Kernel . sys ) 
Windows . sys ) 
Polygon. hgh) 
Axis .hgh) 

{$1  Ut-mod01 . inc  )   {I/O  routines) 
($1  Ut-mod02.inc) 
($1  Ut-mod03.inc  ) 

{$1  GrapMenu. inc )    {graph  options  menu) 


type 
Var 


ary4   =  array  [1..11]  of  real; 
ary6   =  array  [1..21J  of  integ 


nteger ; 

I , J , code ,LineCount  :  integer; 

PlotPole , PlotZero  :  PlotArray; 

PlotRealPole , PlotlmagPole  :  ary3s; 

DeltaGain , StartGain .EndGain , 

Variable  Gain , Xmin , Xmax,Ymin ,Ymax, gain:  Real; 

Neg_Feedback , dumpgraph , quit  :  Boolean; 

list  :  text; 

1 j ,kk1 ,m, 1 , sizezeros , one  :  integer; 

holdpoly , dencoef f ,numcoef f  :  ary4 ; 
realpartpole , imagpartpole ,realpartzero, 

imagpartzero  :  ary3s; 

PSI  :  aryls; 

plotfile  :  file; 

{$1  Polynom. inc ) 
{$1  Rootf ind. inc ) 

Procedure  Pr intGraphData; 

{dumps  root  locus  data  to  printer) 
Begin 

LeaveGraphic ;  Clrscr; 
repeat 

Textcolor ( white ) ; 

gotoxy( 20, 10) : 

writelnT'   **<*    PROGRAM  OUTPUT  OPTIONS  ***   '); 

gotoxyC 20 ,13);  ,  x 

writeln('<P>  Printer  output  '); 

Textcolor  (yellow) ;  gotoxy(  20  . 1  4- ) ; 

writeln( '     Check  Your  Printer!  '); 

Textcolor (white) :  gotoxy( 20 , 1 5  ) ;  . 

writeln('<F>  List  to  File  name  ') 

gotoxy(20, 16);  . 

writeln('     on  the  current  drive  ') 

gotoxy(20,17): 

writeln('<Q>  Quit       ,  ') 


gotoxy( 


writ 


y( 42 , 1 5) ; textcolor (yellow) ; 

( » "RLOCI . RES" ' ) ;  gotoxy ( 28 ,17); 


read( kbd, ch ) :      ,  .     ,  ,     .„.x 

If   ch  =  'F?)  or  (ch  =  'f )  or  (ch  =  'P') .or 

(ch  =  'p ' )  then 


if  (ch  =  'F')  or  (ch  =  'f )  then 
begin 
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gotoxy( 24 , 1 5 ) ; textcolor( red) ; 

write(  ]  PRINTING '); 

assign( list , 'Rloci .RES' ) ; 

rewrite! list ) ; 
end 
else 
begin 

gotoxy( 24 , 1 3 ) ; textcolor( red) ; 

write( ' PRINTING. '  ) 

assign( list , '  LST : • ) ; 

rewrite( list ) ; 
end; 


LineCount  :=  0; 

writelni list ) : 

writeln( list. *   ZEROS  '); 

writeln( list ) ; 

wr ite( list , ' 

writelnC list , »      REAL 


'); 


IMAGINARY' ); 
.ineCo 


writeln( list ) ;    LineCount  :=  LineCount  +  6; 

for  i  : =  1  to  sizeZeros  do 
begin 

writeln( list , '  ' ,RealPartZero[i] : 1 0 : 3 , 

'  * , ImagPartZero[i] : 1 0:3) ; 

LineCount  :=  LineCount  +  1; 
end: 

writeln( list ) :  writeln( list ) ; 
writelnC list . *   POLES'); 
writelnc list ) ; 

writef list, '      GAIN  ' ); 

writeln( list , '      REAL 

IMAGINARY ' ) ; 
writeln( list ) ;  LineCount  :=  LineCount  +  7; 
Variable_Gain  :=  StartGain; 

{compute  root  locations  for  varying  values  of 
gain  and  print  them) 

DeltaGain  :=  (EndGain-StartGain)/50 ; 

For  J:=  1  to  50  do 

Begin 

HoldPoly  :=  dencoeff; 

If  Neg  Feedback  then 

For  I:=  1  to_sizeZeros+1  do, 

HoldPoly [I]  :=  HoldPolyfl]  +      _  _ 
(gain*Variable  Gain  *  numcoeff [I] ) 
else  — 

For  I:=  1  to  sizeZeros  +1  do 


Pole  , 


:=  i  to  sizezeros  +i  qop  _ 

HoldPolyLIJ  :=  HoldPoly[I]  +(  gain  *  . 

Var iable_Gain  *  numcoeff [I J ) ; 

Root_Finder ( size .HoldPoly , Plot Real 
Plot ImagPole , one ) ; 
write In (list .Variable  Gain: 10:4); 
LineCount  :=  LineCount  +  1; 
for  i  : =  1  to  size  do 
begin 

writeln( list , '  _  ',i:2 


PlotRealPole[i] [10:$. 

tij : 10: 


'  ' ,PlotImagPole[i] : 10:3) ; 

LineCount  : =  LineCount  +  1 ; 
end: 

wr iteln( list ) ;LineCount  :=  LineCount  +  1 
if  LineCount  >  50  then 
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begin 

writeln( list ,  chr(12)); 
LineCount  : =  0  ; 
end; 

variable  gain: =variable  gain+deltaGain; 
end;       ~"  ~ 

end; 
until  ch  in  L'Q','q']; 
EnterGraphic ; 
swapscreen: 
close( list ) ; 
end; 


Begin 
one : =1 


1 
2\ 

3. 
4 

5 

6 
7 


_  > 
_  > 


{Root  Locus  Input  handler  driver) 
' 5506N01 001 -01 01 01 ' 

5508N01 002-010103' 

1 512N00503-010101  ' 

1 513N00504-01 01 03' 

1 51 4N00505-01 01 01  ' 

1 51 5N00506-01 01 03' 

4517A00207T010101 ' 


:htblue ) ; 

PLOTTING 


PARAMETERS  *** 


Clrscr;  TextColor  (li, 

writeln( '  ***  ROOT  LOCUS 

TextColor (Yellow) ; 

writeln( '=====================================: 

writeln; writeln: writeln; 

TextColor (green) ; 

writeln( ' Input  STARTING  value  for  the  variable 

gain: ' ) ; 
wr  i  t  e 1 n  * 
writeln( ' Input  ENDING  value  for 

sain:  '  ) ; 
TextColor (yellow) ; 
writeln;  writeln; 


the  variable 


writeln 

writelm 

writelni 

writeln^ 

writelni 

writelm 


TextColor (gr 
'X -Mini mum:  ' 
'X-Maximum:  ' 
' Y-Minimum: 
'Y-Maximum:  ' 
' Positive  or 


■  en)  ; 


writeln; 
Negative  Feedback? 


(  P  or  N  )  :  '  )  ; 


Input  Handler ( 'N01 07' .Escape) : 

{prompt; 

hese  p; 

,F1 ,F1! 


{.prompts  for  NEW  inputs) 
writelnjwriteln; 
writeln('Any  changes  to  these  parameters? 

(Y  or  N): ' ); 
Input ( 'A' , ' '  45, 19, 2, true, F1 ,F10): 

If  answer='Y*  then   Input  Handler (' C01 07 ' .Escape ) ; 

{prompts  for  changes) 


Val(f ilvar [1 ] . St art Gain . code ) 
{conyerts  input  strings 


Vail 

, f ilvar 

.2. 

Val' 

, f ilvar 

.3 

Val- 

> f ilvar 

.4. 

val  l 

. f ilvar 

5 

Vail 

,  f ilvar 

6 

,EndGain ,  c< 
, Xmin , code 
, Xmax, code 
, Ymin , code 
, Ymax, code 


>de); 


into  numeric  values) 


If  copy(filvar [7] , 1 , 1 )  <>  'N'  then 

Neg  feedback  :=  false 
else  Neg_feedback  :=  true; 

INITGRAPHIC: {define  values  for  graphics  routine) 
NICEAXES(xmin, xmax, ymin, ymax, ' ' ); 
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Characteristic_equation( A1 A, size , dencoef f ) ; 
(calculate  dencoef f  from  the  plant  matrices) 
for  i:=1  to  size  do 

(calculate  numcoeff  from  the  given  plant  matrices) 
begin. 

PSI[i ,size] :=B[i , 1 ] ; 
end; 

for  jj:=2  to  size  do 
begin 

for  i:=1  to  size  do 

begin 

T:=size-j j+1 - 

*  B[i,l] 


kk1  •  -j+1 

PSlti.d J :=dencoeff [kk1] 

for  !:■"  to  size  do 


efs?[i,d] :=PSI[i,j]  +A1A[i,l]  *  PSI[l,kk1]; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

numcoeff [i] :=0.0; 
for  j:  =  1  "to  size  do 
begin 

numcoeff [i] :=numcoeff[i]  +  PSI[j,i]  *  C[1,j]; 
end; 
end; 

for  i:=1  to  size  do 
begin 

Qj»  r sizS"i"1 i  * 

if  numcoeff [m]  <>  0.0  then  goto  1; 
end; 
1 : sizezeros : =m-1 ; 

(calculate  the  zeros  of  the  system) 
root  f inder ( sizezeros , numcoef f , realpartzero , 
imagpartzero , one ) ; 

gain : =numcoef f [sizezeros+1  ] ; 
(convert  highest  degree  numerator  coefficient  into  1.) 

for  i:=1  to  sizezeros+1  do 

numcoeff [i] : =numcoef f [i J /gain; 

to  sizeZeros  do 


For  I:=1 
Begin 

PlotZeroCl, 1 ] 


PlotZer 
end;  (for 
Case  size 
0 

1 


=  RealPartZeroCl]  ; 
o[IJ  ; 


:=  ImagPartZer 
eros  of 


begin 

PlotZero 
PlotZero 
PlotZero 
PlotZero 


.2,1. 
.2,2. 
.3,1 
3,2 


=PlotZero 
=PlotZero 


=  PlotZero  .1 


=PlotZero 


*■ 


1  ,2] 


end; 
begin 


NICEAXES( xmin ,xmax ,ymin ,ymax, ' ' ) : 
DrawPolygon( PlotZero ,1 ,-3,-3,3,0); 


PlotZero [3, 1 ] :=PlotZero[1 , 1 ] ; 
Plot Zero [3, 2 J :=PlotZero[1 ,2] ; 


end; 
else 


NICEAXES( xmin , xmax ,ymin ,ymax, ' ' ) : 
DrawPolygon( PlotZero, 1  ,-3,-3,3,0)  ; 


NICEAXES( xmin .xmax, ymin ,ymax 
DrawPolygon( PlotZero ,  1  ,sizeZ 


'  ) ; 
erosl -3,3,0); 
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Variable  Gain  :=  StartGain; 
DeltaGain  :=  ( EndGain-StartGain) /50 ; 
{divide  gain  to  plot  50  points) 

For  J : =  1  to  50  do 

{calculate  and  plot  50  points  per  graph) 
Begin  *        &  * 

HoldPoly  :=  dencoeff; 


If  Neg_Feedback  then 
For  I:=    to,SizeZeros+1 
'II 


HoldPoly Tl]  :=  HoldPoiyfl]  ■ 
(gain*Variable  Gain 


else 

For  I:=  1  to  SizeZeros  +1  do 
HoldPoly £1]  :=  HoldPoly£lJ  - 
(Gain  "Variable  Gain 


*  numcoeff [I] ) 


*  numcoeff [I] ) ; 


Root_Finder ( size .HoldPoly , PlotRealPole , 
PlotlmagPole , one ) ; 

For  I:=]  to  size  do 

{fill  plotting  matrix  with  poles) 
Begin 


FlotPoleEl,  1  ] 
[1,2] 


PlotPole 
end; 

AxisGlb  :=  true; 
Case  size  of 

{artificially  fill 
than  3  points) 


=  PlotRealPole [I] ; 

=  PlotImagPole[l] ; 


plotting  array  if  fewer 


0 
1 


begin 

PlotPole 
PlotPole 
PlotPole 
PlotPole 


2,1 
3,2^ 


=PlotPole 
=PlotPole 
=PlotPole 
=PlotPole 


1 


[1  ,2] 


NICEAXES( xmin , xmax.ymin ,ymax , ' » ) : 
DrawPolygon( PlotPole, 1  ,-3,-1 ,3,0) ; 


endj 
2:   begin      _  _ 

PlotPole[3,1] := Plot Pole [1 ,1] ; 
PlotPolel3,2J :=PlotPole[1 ,2] ; 
NICEAXES(xmin,xmax.ymin,ymax, ' ' ) : 
DrawPolygon( PlotPole, 1 ,-3,-1 ,3,0); 
end; 
else 

NICEAXES(xmin.xmax,ymin,.ymax,  '  '  );  . 
DrawPolygon( PlotPole , 1 , size , -1 ,3,0); 
end*  {case) 

variable_gain: =variable_gain  +  Deltagain; 
end; 

Repeat  until  KeyPressed; 

quit  :=  false; 
repeat       ,  . 

Graph  Menu( 'Root  Locus ' .DumpGraph , quit ) ; 

~      {calls  print/title  menu) 
If  DumpGraph  then   Pr intGraphData; 
until  quit* 

LeaveGraphic :  ,  . 

Assign(plotf lie, 'plot .com' ) ;  {re-execute  plot.com) 
Execute (plotfile ) ; 
end.  {root  locus) 
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Program  Roots; 

label  1;  {label  decleration  for  goto  statement) 

($1  Typedef . sys > 


TYPE 

ary6  =  array  [1..21]  of  integer; 


ary4  =  array  [1..11]  of  real; 
ay  [1  ..21  J  o:~ 


var 

posCounter ,i,j ,Jj ,  kk1 ,m, 1, 
cnpoles .sizezeros , one :  integer; 
dencoef f , numcoef f , cdencoef f :  ary4 ; 
realpartzero, imagp art zero , 
crealpartpole , cimagpartpole  :  ary3s; 
PSI  :  aryls; 

plotfile   :file; 
gain       :real; 

($1  Polynom.inc) 
($1  Rootf ind. inc } 

BEGIN 

ClrScr ;  one : =1 ; 

Characteristic_equation( A1 A, size , Dencoef f) ; 
for  i;=1  to  size  do  „ 
PSI[i,sizeJ:=B[i,l]; 

for  jj:=2  to  size  do 
begin 

for  i:=1  to  size  do 

begin 

i  :=size-jj+1 ; 


kk1 • =i+l 

PSlti.d] :=Dencoeff [kk1 

for  1:=1  to  size  do 


]  *  B[i,l]; 


?SI[i,j] :=PSI[i,j]  +A1A[i,l]  *  PSI[l,kkl]; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

Numcoef f [i] : =0.0; 
for  ]:»1  to  size  do 

e§umcoeff [i] : =Numcoef f [i]  +  PSI[j,i]  *  C[1,j]; 

end; 
end; 

for  i:=1  to  size  do 
begin 

m: =size  +  1 -i  i 

if  numcoeff [m]  <>  0.0  then  goto  1; 
end; 
1 : sizezeros : =m-1 ; 

root_f inder ( sizezeros , Numcoef f, realpartzero , 
imagpartzero , one ) ; 

?ain:=  Numcoef f [sizezeros  +  1  ] ; 
or  i:=1  to  sizezeros+1  do 
begin 

Numcoeff [i] :=  Numcoef f[i] /gain ; 
end; 

for  i:=1  to  maxorder  do 

CDenCoeffLil  :=  0.0;    (initialize) 
for  i:=1  to  Sizezeros  +  1  do„  , 

CDenCoeffLil  :=  Numcoef f[i]  *  gain; 
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for  i:=1  to  Size  +  1  do 

CDenCoeffLiJ  :=  CDenCoeff[i]  +  Dencoeff [i] ; 

if  Size  >  SizeZeros  then  CNPOLES: =Size 
(NPoles  should  always  be  greater) 

else  CNPOLES: =SizeZeros; 

_.  .   ,  „    , {compute  new  denominator  roots) 
root_f inder ( Cnpoles , CDenCoef f , CReal Part Pole , 
CImagPartPole ,one) ; 

ClrScr ;  text col or ( lightblue ) ;{ on-screen  titles) 
writelnC      ***  Plant  Characteristic  Equation 

Roots  ***');  M 

writeln:  wr  iteln jhighvideo ; 
writeln( 'ROOTS  OF  THE  NUMERATOR:  '); 

For  I:=1  to  SizeZeros  do  {position  for  output) 
begin 

PosCounter  :=  (I  mod  2)  ; 

If  PosCounter  =  1  then  writeln; 

LowVideo:   (write  zeros  ) 

write( 's[ ' ,1, ' J  =  ' .RealPartZeroII] : 1 0 : 3 , 

'  +j  '  , ImagPartZero[IJ :  1  0:3) ; 
wr ite(  '  '  )  ; 

end; 

writeln:  writeln;  HighVideo: 

writelnC 'ROOTS  OF  THE  DENOMINATOR:  '); 

For  I:=1  to  CNPoles  do 

begin        {compute  on-screen  position) 

PosCounter  :=  (I  mod  2)  ; 

If  PosCounter  =  1  then  writeln; 

LowVideo ; 

(output  roots) 
write  's[' ,1, ']  =  '. CReal PART POLE! I J : 1 0 : 3 , 

'  +d  '  ,CImagPARTPOLELIJ :  10:3) ; 
write( '  ' ); 

end; { for ) 

HighVideo;gotoxy( 1 ,24) ; 

write( 'Press  any  key  to  continue  or  [Shift]  [PrtScJ 
for  hardcopy.'); 

(check  keyboard  buffer  for  value  change. 
If  number  changes  by  1  or  2  indicates  that  shift  key 
depressed.   If  so,  then  remove  "Press  any  key..." 
prompt  from  screen  so  it  won't  print  to  printer) 

keyold  :=  mem[0000 : 1 047] ;  not_erased  :=  true; 
Repeat 

key  :=  mem[0000 : 1 047] ; 

if  ((key=keyold  +  1 )  or  (key=keyold  +2))  and 
(not_erased)  then 
begin   ,  , 

GotoXY(  1  ,24)  ;  writeC  ':80); 
not_erased  :=  false; 
end; 
Until  KeyPressed; 

Assign(plotf ile , ' Plot . com' ) ; 
Execute (plotfile ) ; 

end.  {Program  Roots) 
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Program  Matr ix_Manipulation( input , output ) ;      I 

($1  Typedef.SYS) 

($1    Box. INC) 

{$1    Ut-mod01 .INC) 


var 


help3f ile , inversef ile , determinf ile , 
Polynomf ile , eigenf ile  :file; 


Procedure  Matrix_mathematics_menu; 
var 


i  ,Tab 

Okchoice 

Finished 


Integer : 
Set  Of  Char 
Boolean; 


Procedure  Menultem( Pick : Char ;Description  :Str80; 

Color : Integer ) ; 

Begin 

TextColor ( color ) : 

Write  ('  ':tab,'(');  TextColor (white ) :  Write(pick); 

TextColor ( color);  Writeln( ' ) ' .Description); 
End; 

Begin 

ClrScr:  TextColor (white ) ;  Finished  :=  False; 

GoToXYM9,4J: 

WriteP***  MATRIX  MATHEMATICS  MENU  ***'); 

for  i  :=  1  to  4  do  writeln( '  '); 

Tab  : =  16* 

Menuitemf *D' , 'Determinant  of  A  Matrix' .yellow) ; 

Menultem( ' C ',' Character istic  polynomial  of  A 

Matrix'  vellow) * 
Menultem( ' I ',' Inverse ' of  A  Matrix' ,. yellow); 
Menultem( 'E' , 'Eigenvalues  of  A  Matrix' , yellow) ; 
Writeln; 
Writeln; 

Menultemi ' H ' , ' Help ' . lightmagenta) ; 

Menultem( ' Q ' , ' Quit  to  SVS  Main  menu  ', lightmagenta) ; 
TextColor(green) ; 

TextColor (white);  GoToXY  (40,22); 
Repeat 

Option; 
until  ch  in  [ 'D ' , ' C ' , ' I ' , 'E ' , 'H ' , ' Q ' ] ; 
case  ch  of 
'D' :  begin 

Assign( determinf ile , ' determin.chn ' ); 
Chain ( determinf ile ) ; 
endj 
' I ' :  begin 

Assign( inversef ile , ' inverse . chn ' ); 
Chain ( inversef ile ) ; 
end; 
'C  :  begin 

Assign( Polynomf ile , ' Polynom. chn ' ) ; 
Chain( Polynomf ile ) ; 
end; 
'E' :  begin 

Assign( eigenf ile , 'eigen.chn' ); 
Chain ( eigenf ile ) ; 
end; 
' H ' :  begin 

Assign(help3File,  'help3.CHN'  ); 
Chain(help3File); 
end; 

92 


FILE:  MATRIX. PAS      Program  Listing  Page  2 

'Q'  :  begin 

Assign( SvsFile , 'svs.COM' ); 
Execute! SvsFile ) ; 
f    end: 
End;  (case) 
End; 

Begin  {main  program) 
Clrscr  ; 
Repeat 
begin 

Mat  r  i  x_Mat hemat  i  c  s_Menu ; 
end; 
Until  Finished  =  True; 
End. (main  program) 
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Program  Matrix  Determinant ( input , output ) ; 

label  1 0; label-20; label  30; label  40; label  50; label  60; 

label  70; label  80; 

Typedef .SYS) 


var 


Ut-mod01 . IN_ 
Boxuser . INC) 

matrixfile  :file; 
list       :text; 
counter , i  ,  j ,ii,k,m,n, even  : integer ; 

temp  value , value , det , det_corr ection , 
determinant  old, determinant         :real; 
A1  —  :ary1s; 

Begin 

counter  :=  0; 

Boxuser ; 

for  i:=1  to  size  do 

Begin 

for  j:=1  to  size  do 
Begin 

X1  [i,j]:=  A1A[i,j]; 
End; 
End; 

for  i:=  1  to  size  do 
Begin 
k  :  —  i  * 

30:if  A1[k,i]  <>  0.0  then  goto  10; 
k  t  =k+ 1  * 

if  (k-size)  <=  0.0  then  goto  30; 
goto  40: 

10:if  (i-k)  >  0.0  then  goto  40; 
if  (i-k]  =  0.0  then  goto  70; 
for  m:=1  to  size  do 
Begin 

^.lue  :  =A1  IX  ,mj  ; 
A" 
A 
End; 

counter :=  counter+1 ; 
70: ii : =i+1 ; 

if  ii  >  size   then  goto  20; 
for  m:=ii  to  size  do 
Begin 

if  Al[m.il  =  0.0  then  goto  80; 
value : =A1 [m, i J  /  A1[i,iJ; 
for  n:=  i  to  size  do 
Begin 

A1[m,n]:=  A1[m,n]  -  Al[i,n]  *  value; 
End; 
80 :End; 
20:End; 
det : =1 .0; 

for  i:=1  to  size  do 
Begin 

det:=det  *  A1[i,iJ; 

det  corrections  exp(  counter  *  LNM  )); 

determinant  old:=det  correction  *  det; 

even : =  counter  mod  2T 

if  even  <>  0  then  goto  60: 

determinant  :=  determinant_old; 

,e;oto  50; 

60 : determinant : =-determinant_old; 

goto  50; 

40 : determinant : =0 . 0  ; 

50:clrscr;writeln;TextColor(yel low) ; 
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Writeln('The  given  matrix  is  :  ');  writeln; 

for  i:=  1  to  size  do 
Begin 

for  j:=  1  to  size  do 

Begin 

Write( »   ' ,A1A[i,j] :1 1 ); 

End;Writeln; 
End; Writeln; Writeln; 

Write('The  determinant  value  is  :'); 
TextColor( white ) ;writeln( determinant ) ; 

keyread(key ,keyold,not_erased) ; 

Repeat 

box  printer ; got oxy( 58, 1 5 ) ; text col or (yellow) ; 
writelnf' "DETERMIN. RES" ') ; 
gotoxyC 1 .25) ;w 

r  e ad (  ku d  ch  )  * 
if  (ch='F')  or  (ch='f')  or  (ch='P')  or  (ch='p') 
then  begin 

if  fch='F')  or  ( ch= ' f ' )  then 
begin 

gotoxyC 45 , 1 5 ) ; textcolor ( red) ; 

write(  '  PRINTING '  )  ; 

Assign(list. ' Determin.RES • ); 
Rewrite! list ) ; 
end: 

if   chs'P')  or  (ch='p')  then 
begin 

gotoxyC 45 ,13); textcolor ( red) ; 

write(  'PRINTING '); 

Assign( list , 'LST: ' ); 
Rewrite! list ) ; 

writeln(list , '  DETERMINANT 

Result   » ) ; 

writeln( list ) : 

writelnC list . ' The  given  matrix  is:'); 

wr iteln( list ) j 

for  i:=1  to  size  do 

begin 

for  j:=1  to  size  do 

ewrite(list. »   '  A1 A[i , j ] : 1 1  ) ; 
end ;writeln( list ) ; 
end; writelnl list);writeln(list); 
WriteC list ,' The  determinant  value  is  :  '); 
writeln(list .determinant ) : 
writeln( list );writeln( list); 
close( list ) ; 
end;       _        _ 
Until  ch  in  ['Q' , 'q'] ; 

Assign(matrixf ile , 'matrix.com' ); 
Execute(matr ixf ile ) ; 

End. 
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Program  Matrix  inverse( input , output ) ; 
($1  Typedef.SYS) 

<$I  Ut-mod01 . INC) 
{$1  Boxuser.inc) 

"type 

ary4    =  array  L1..11J  of  real; 
ary6    =  array  [1..21]  of  integer; 
var 

matrixfile  :file; 
list       :text; 
polynom_coef f      : ary4 ; 
Ainverse  :ary1s; 

singular , step , stepper  : integer; 


($1  Polynom.inc) 
{$1  Inverse. inc) 


begin 

clrscr:  Boxuser ;  singular :=0; 

character i st ic_equat ion ( A1 A, size , Polynom_coef f ) ; 

i  r-rerse_f  ind_matrix(  A1  A,polynom_coef  f  ?  size  ,  Ainverse  , 

polynom  coeff, singular ) ; 
clrscr ; t ext col or (yellow) ; 

writeln('The  given  matrix  is:  ');  writeln; 
for  step:=1  to  size  do 
begin 

for  stepper :=1  to  size  do 
begin 

write( '   ' ,A1A[step , stepper] : 1 1 ) ; 
end;wr iteln; 
end; writeln; 
if  singular=1  then 

writeln('The  matrix  is  singular.') 

else 

begin 

writeln('The  inverted  matrix  is : ' ) ;writeln; 

for  step:=1  to  size  do 

begin 

for  stepper  :  =  1  to  size  do 
begin 

write( '   ' , Ainverse[step , stepper] : 1 0 , '   '); 
end;writeln; 
end; 
end; 

keyread(key ,keyold,not_erased) ; 

Repeat 

box  printer ;gotoxy( 58, 1 5 ) ; t ext col or ( yellow) ; 
writelnC ' "INVERSE .RES ft ' ) ;  gotoxyt 1 ,25) ; 
write( »  * ) ; 

#ead?k^d9chT-  '' 

ifa(ch='F^)  6r  (ch='f)  or  (ch='P')  or  (ch='p') 
then  begin 

if  (ch='F')  or  (ch='f)  then 
begin 

gotoxy( 45 , 1 5 ) ; textcolor ( red) ; 

write!  *  PRINTING '  )  ; 

Assign( list , ' Inverse . RES ' ) ; 

Rewrite! list ) ; 
end; 

if  (ch='P')  or  (ch='p')  then 
begin 
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gotoxy( 45 , 1 3 ) ; text col or ( red) ; 

write!  ^PRiNTING '); 

Assign(list, 'LST: ' ); 
Rewrite! list ) ; 
end: 
writeln(list , '  MATRIX  INVERSE 

RESULT    » ) ; 
writelni list ) : 

writelnc list .' The  given  matrix  is:'); 
writeln( list ) ; 
for  step:=1  to  size  do 
begin 

for  stepper :=1  to  size  do 
begin 

write(list,'   ' , A1 A[step , stepper] : 1 1  ) ; 
end; writeln( list) ; 
endjwriteln( list );writeln( list); 
begin 

writelni list .' The  inverted  matrix  is:'); 

writeln( list  ) ; 

for  step:=1  to  size  do 

begin 

for  stepper :=1  to  size  do 
begin 

write( list ,  '  '  , _  _         . 

Ainverse[step , stepper  J : 1 0 ,  '   '); 
end; writeln( list) ; 
end; 
end; 

writeln( list );writeln( list); 
close( list ) ; 
end;      _        _ 
Until  ch  in  [ 'Q' , 'q'] ; 

Assign(matrixf ile , 'matrix.com' ); 
Execute ( mat r ixf ile ) ; 

end. 
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Program  Matrix  Manipulation( input , output ) ; 
($1  Typedef  .SYSK,  , 

($1  Ut-mod01 . INC}{$I  Boxuser.inc) 

"type  .  ..-,      ~         n 

of   real; 


ary4         =    array     .1  .  .  1  1 
ary5         =    array     .  1..21 


ary6    =  array 


of  real; 


1..21J  of  integer; 


var 


matrixfile  :file; 

list       :text: 

c2,C1       :ary4; 

Real Part , Imaginary Part : ary3s ; 

i,j,one      : integer; 

($1  Polynom. inc ) 
($1  Rootf ind. inc } 

begin 

clrscr rBoxuser ; one : =1 ; 
characteristic_equation( A1 A, size , C1  ) ; 

root_Finder ( size . C1 , RealPart , ImaginaryPart , one ) ; 

clrscr ; Text co lor (yellow) ; 

writelnt'The  given  matrix  is : ' ) ; wr iteln; 

for  i:=1  to  size  do 

begin 

for  j:  =  1  to  size  do 

begin 

write( '   ' ,A1A[i,j] :1 1 ); 

end; writeln; 
end; wr iteln; write In; 

writeln('The  eigenvalues  of  the  matrix  are:  '); 
writeln  '  REAL  PART 

IMAGINARY  PART ' ) ; 
for  i:=1  to  size  do 
begin 

write  '        _  _  ' ) ; 

write( RealPart [i] :3) ; 

write 

write 
end; 

keyread(key ,keyold,not_erased) ; 

Repeat 

box  printer ; got oxy( 58, 15); text color (yellow) ; 
writeln( ' "EIGEN.RES" ' ) ;  gotoxy( 1 ,25) ; 
write( '  ' ) ; 

gotoxy(49,17); 

read(kbd.ch) ;   .       .  . 

if  (ch=,F')  or  (ch='f)  or  (ch='P')  or  (ch='p') 
then  begin % 

if  (ch=,F*)  or  (ch='f)  then 
begin 

gotoxy( 45 ,1 5 ) ; textcolor  (  red) ; 

write(»  PRINTING '); 

Assign(list. 'Eigen.RES' ); 
Rewrite(lis-fc); 
end: 

if  (ch='P')  or  (ch='p')  then 
begin 

gotoxy( 45 ,1 3  ) ; text col or ( red) ; 

write  Printing. ...... .       '); 

Assign( list,  ' LST :  '  )  ; 
Rewrites  list ) ; 
end; 
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writeln(list , »  EIGENVALUES 

RESULT    ' ) ; 
writelnf list ) : 

writelnf list .  * The  given  matrix  is:'); 
writelni list ) ; 
for  i:=1  to  size  do 
begin 

for  j:  =  1  to  size  do 

begin 

writeClist, |   ' ,A1A[i,j] :11 ); 

end;wnteln( list ) ; 
end: writ eln( list); write In (list); 
wr iteln( list , ' 

The  eigenvalues  of  the  matrix  are:  '); 
writeln  list , '  REAL  PART 

IMAGINARY  PART  »  ) ; 
for  i:=1  to  size  do 
begin 

write  list ,  '        _  _    x        '  ) ; 

write! list , Real Part [i] :  1  0 )  : 

writeClist,'       +1      ;): 

writeClist, Imaginary Part [i J :  1  0 ) ; 

wr  iteln( list ) ; 
end; 

writeln( list );writeln( list); 
close( list ) ; 

Until 'ch  in  [ ' F '  ,  ' f '  ,  ' P '  ,  'p '  ,  ' Q '  ,  ' q ' ]  ; 

Assign(matrixf ile , 'matrix.com' ); 
Execute ( mat rixfile ) ; 

end. 
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Program  Matrix  Characteristic  Equation( input , output ) ; 

$1  Typedef.SYS),  - 

($1  Ut-mod01 . INC) 
{$1  Boxuser.inc) 
type 

ary4    =  array  [1..11J  of  real; 

ary6    =  array  [1..21]  of  integer; 

var 

matrixfile  :file; 
list       :text; 
C1  :ary4; 

i,j , vertpos .horizpos ,poscounter   : integer; 
exponent  :string[2J; 

{$1  Polynom.inc) 

begin 

clrscr : Boxuser ; 

characteristic  equation( A1 A, size , C1 );clrscr; 

Textcolor (yello"w)  ;    writeln; 

wr itelnt  ' The  given  matrix  is  :  ');writeln; 

for  i:=1  to  size  do 

begin 

for  j:  =  1  to  size  do 

begin 

write( '   ' ,A1A[i, j] : 1 1 ); 

end;writeln; 
end*writeln  *writeln  * 
wri-f;eln(  '  The  characteristic  polynomial  of  given 

matrix  is :  ' ) ; 
vertpos : =size+7 ; 
for  i:=size+1  downto  1  do 
begin 

-i  •  =siz6+1 i  * 

poscounter :=( j  mod  4)  +1 ;hor izpos : =poscounter  *  14; 

if  poscounter  =  1  then  vertpos : =vertpos+2 ; 

if  i  <>  1   then 

begin 

gotoXYChor izpos- 1 0 , vertpos ): write ( C1 [i] :7 :4 ) ; 

msg( '  S  +' ,horizpos , vertpos ) ; 

str ( i-1 : 2 , exponent ) ; 

msg(exponent ,horizpos+1 ,vertpos-1 ); 
end 
else 
begin 

§otoXY (hor izpos -1 0 , vertpos );write(C1 [i]:7:4); 
; 
end; 

keyread(key ,keyold,not_erased) ; 

Repeat 

box  printer :gotoxy( 58, 15); textcolor (yellow) ; 
writelnf ' "POLYNOM. RES* ' ) ; 

gotoxyt 1 . 25 ) :write( '  '); 

Sot9^7H9,17); 
readi  Pcud  en.  )  * 

if  (ch=,F')  or  (ch='f)  or  (ch='P')  or  (ch='p') 
then   begin 
if  (ch=,F')  or  (ch='f)  then 
begin 

got oxy( 45 ,1 5) ; textcolor ( red) ; 

write('  PRINTING '); 

Assign( list , ' Polynom. RES ' ) ; 
(list) ; 


Rewrite 
end; 
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if  (ch='P')  or  (ch='p')  then 
begin 

gotoxy( 45, 13) ; text col or ( red) ; 

write(  !  PRINTING '); 

Assign(list , ' LST : ' ) ; 
Rewr ite( list ) ; 

writeln(list , '  POLYNOMIAL 

RESULT    ' ) ; 
writelni list ) : 

writelni list <  The  given  matrix  is:'); 
writelni list ) j 
for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

begin 

write (list. '   '  A1 A[i , j ] : 1 1 ) ; 

end; writeln( list); 
end; writelni list ); writ eln( list ) ; 
write( list ,' The  characteristic  polynomial  of 

given  matrix  is:'); 
writelni list . '  (  Descending  power  of  S  )  '); 
wr iteln( list) ; 
for  i:=size+1  downto  1  do 
begin 

write(list  ,C1  [i]  :  7  :  4- ,  •   '); 

str(i-1 : 2 , exponent ) ; 
end: 

wrixeln( list );writeln( list); 
close( list ) ; 
end;       _        _ 
Until  ch  in  ['Q' , 'q'] ; 

Assign(matrixf ile , 'matrix. com' ); 
Execute (matrixf ile ) ; 

end. 
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Program  Control ( input , output ) ;        \ 
{$1  Typedef.SYS) 

{Program  type  and  variable  definitions) 
{$1  Ut-mod01 .INC)  {input  utility  programs) 

type 

Ary1    =  Array [1  .. 1 1  , 1  ..  1  1  ]  of  real; 
var 

Stepping, Steps , step , steppings , 

Tempi , Temp2 , value 1 , value2 ,m,mplus , 

last_rank ,  k, value 1  plus .kplus        : integer ; 

new_matr ix1 ,new_matr ix2  :ary1s; 

big  matrix  :ary1; 

list  :text; 

($1  control. inc)   {finds  controllability  result) 

($1  Boxuser.inc) 

Begin 

valuel  :=  1;  value1plus:=  valuel  ; 
ClrScr ; Text col or (yellow) ; 
Writeln('The  A  matrix  is  :  ' );writeln; 
For  steps  : =  1  to  size  do 
Begin 

For  stepping  : =  1  to  size  do 
Begin 

write( '   ' ,A1A[steps, stepping] : 1 1 ) ; 
End;  Writelnj 
End : wr i teln ; write In j 

Writeln('The  B  Matrix  is  :  ');writeln; 
For  steps  :=  1  to  SIZE  do 
Begin 

for  stepping: =1  to  ni  do 
begin  _ 

Write( '    ,B[steps , stepping] : 1 1 ) ; 
end;wr iteln; 
End;writeln:writeln; 
For  steps:=1  to  size  do 
Begin 

For  stepping  :=1  to  ni  do 
Begin 

new_matrix2 [steps , stepping]  :=  B[steps , stepping] ; 

new_matrix1 [steps , stepping]  :=  B[steps , stepping] ; 

End; 
End;  mplus:=  size-1 ;  value2 : =value1 ; 
For  steps  : =  1  to  mplus  do 
Begin 

matrix  multiplication( A1 A,new_matr ix1 . 
new  matrixl  .  size  ,  size".  value2  ) ; 
step  :=  valuel  +1;  valuel  :=  valuel  +  value2; 
For  k  : =  1  to  size  do 
Begin 

For  stepping  :=  step  to  valuel  do 
Begin 

steppings  :=  stepping-step+1 ; 
new_matrix2[k, stepping] := 

new  matrixl [k, steppings] ; 
End;  ~ 

End; 
End; 

For  steps  :=1  to  size  do 
Begin 

For  stepping: =1  to  valuel  do 
Begin 

big  matrix[steps , stepping]   := 
new  matrix"2  [steps  ,  stepping]  ; 
"End; 
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End;  mplus : =1 ; 

For  steps  :=1  to  size  do 

Begin 

Matrix_reduction( big  matr ix, mplus , size , last  rank); 
mplus  :=  last  rank  +1;  — 

End;  ~~ 

If  last  rank  =  size  then 

WritelnC 'The  system  is  controllable.  ' );Writeln; 

If  last  rank  <  size  then 

Writeln  ('The  system  is  uncontrollable.   ');Writeln; 

valuel : =value1plus ; 

KEYREAD(KEY,KEYOLD,NOT  ERASED); 

reiDeat  "~" 

box  printer ;gotoxy(58, 1 5) ; textcolor (yellow) ; 
writelnf '"C6NTR0L . RES'"  );  J 

gotoxyC 1 ,25 ) :write( '  '); 

Read(kbd, ch ) ; 

If  (ch='F')  or  (ch='f)   or  (ch='p')  or  (ch='P') 

then   Begin 

If  (ch='F')  or  (ch='f)  then 
Begin 

gotoxy( 45 , 1 5 ) ; Textcolor  (  red) ; 

writelnC 'PRINTING '); 

Assign( list , 'control .RES' ) ; 
Rewrite( list ) ; 
End; 

If  (ch='P')  or  (ch='p')  then 
Begin 

gotoxy(45 , 1 3 ); Textcolor ( red) ; 

writelnC  '  PRINTING »); 

Assign( list. 'LST: ' ); 
Rewrite! list ) ; 
End; 
Writeln  list,  '  CONTROLLABILITY 

RESULT     ' ) ; 
Writelni list ) : 

WritelnC list .* The  Plant  matrix  A  is  :  '); 
wr iteln( list ) ; 
For  steps  : =  1  to  size  do 
Begin 

For  stepping  : =  1  to  size  do 
Begin 

write(list. '   ' ,A1A[steps, stepping] : 1 1 ) ; 
End ; WritelnC list ) ; 
End; WritelnC list ) ; Wr iteln( list ) ; 
WritelnC list .' The  input  Matrix  B  is  :  '); 
writeln( list ) ; 
For  steps  : =  1  to  SIZE  do 
Begin 

For  stepping  :=  1  to  ni  do 
Begin 

Write(list,'   ',B[ steps, stepping] : 1 1 ) ; 
End;wr itelnC list ) ; 
End:WritelnClist);Writeln( list ) ; 
If  last  rank  =  size  then 

WritelnC list ,' The  system  is  controllable.  '); 
Writeln; 

If  last  rank  <  size  then 

Writeln- ( list ,' The  system  is  uncontrollable.  '); 
Wr*  i  "h  p  1  n  * 

writeln( list); writelnC list); 
CloseC list ) ; 
End; 
Until  Ch  in  I'Q' , 'q'l;   % 
Assign(SvsFile, ' svs .COM' ) ; 
Execute! SvsFile ) ; 
End. 
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Program  Observabil ity( input .output ) ; 
label  1; label  2; label  3; label  4; 

{$1  Typedef.SYS)   {program  type  and  definitions) 

type 


Ary1    =  Array [1 .. 1 1 , 1 .. 1 1 ]  of  real; 


var 


stepping, steps , step , tempi , temp2 , 

add_no , value2 , last_rank  :  integer; 

matrix  :  aryl s ; 

matr ix_matr ix  :  aryl ; 

list  :  text; 

Boxuser . inc  ) 
Control . inc ) 
Ut-mod01  . inc  )   {utility  input  routins) 

Begin 

ClrScr;  Textcolor (yellow) ; 

Writeln('The  Plant  matrix  A  is:  ');writeln; 

For  steps  :=  1  to  size  do 

Begin 

For  stepping  : =  1  to  size  do 
Begin 

Write( '   ',A1A[steps, stepping] : 1 1 ) ; 
End; Writeln; 
End: Wr iteln;wr iteln; 

Writeln('The  output  Matrix  C  is  :  ' );writeln; 
For  stepping  :=  1  to  no  do 
begin 

for  steps  :  =  1  to  size  do 
begin 

Write( '   ', C[stepping, steps] : 1 1 ) ; 
end; writeln; 
end: 

writeln; writeln; 
add_no:=no;  value2  :=1; 
For  steps :=  1  to  no  do 
Begin 

For  stepping: =1  to  size  do 
Begin 

matr  ix_matr  ix[steps  ..stepping]  :  = 

C [steps, stepping] ; 
matr ix [steps , stepping] : =  C [steps , stepping] ; 
End; 
End; 

4 : matr ix_reduction( matr ix_matrix, add_no , 

size, last  rank); 
{calculate  the  rank  of  the  matrix) 
If  last  rank  <  size  then  GoTo  2: 
Writeln('The  system  is  observable  with  index  ', 

value2,'  . '  );Writeln; 
KEYREAD(KEY,KEYOLD,NOT  ERASED); 
GoTo  1  ;  "" 

2: If  value2  <  size  then  GoTo  3; 
Writeln  ('The  system  is  unobservable .  '); 
KEYREAD ( KEY , KEYOLD , NOT  ERASED ) ; 
Writeln:GoTo  1:        — 
3:value2  :=  value2+1 ; 

mat r ix_mul t ip 1 i cat ion (matrix, A 1  A, mat rix.no, 

size . size  ) ; 
{multiply  the  A  and  C  matrices  ) 
For  steps  : =  1  to  no  do 
Begin 

step:=  last_rank  +  steps; 
for  stepping: =1  to  size  do 
Begin 
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matrix_matrix[step .stepping]  := 
„  _  matrix[steps , stepping] ; 

End; 
End; 

add  no  :=  last  rank  +  no; 
GoTo  4;        - 
1 : repeat 

Box  printer :gotoxyC58. 1 5) ; Textcolor (yellow) ; 

writelnC ' "OBSER.RES" ' 5;  gotoxy( 1 , 25 ) ; 

write( '  '  ) : 

gotoxv:(49,  17); 

ReadCKbd, ch) ; 

If  (ch='P')  or  (ch='p')  or  (ch-'F*)  or  (ch='f) 

then  Begin 

If  (ch='F')  or  (ch='f)  then 
Begin 

GotoXY(45, 15) ; textcolor (red) ; 

writelnC  '  PRINTING »  )  ; 

Assign(list, 'obser.RES' ); 

(print  observability  output  ) 
Rewrite! list ) ; ( to  file  on  the  current  drive) 
End: 

If  (ch='P')  or  (ch='p')  then 
Begin 

gotoxy(45 , 1 3) ; textcolor ( red) ; 

writelnC  '  PRINTING »  )  ; 

,  AssignClist , 'LST: ' ); 

(print  observability  result  to  the  printer) 

Rewrite( list ) ; 
End; 
Writeln(list , '  OBSERVABILITY  RESULT   '); 

WritelnC list ):Writeln( list); 

WritelnC list .* The  Plant  matrix  A  is  :'); 

writelnC list ); 

For  steps  : =  1  to  size  do 

Begin 

For  stepping  : =  1  to  size  do 

Begin 

write (List , '   ' , A1 A[ steps , stepping] : 1 1 ) ; 

EndjWritelnCiist); 
End;Writeln(list); WritelnC list) ; 
WritelnTlist . 'The  Output  Matrix  C  is  :  ♦); 
writeln( list ) ; 
For  steps :=  1  to  no  do 
begin 

for  stepping: =1  to  size  do 

begin 

Write( list , '   ' ,C [steps , stepping] : 1 1 ) ; 

end ;writeln( list ) ; 
end; Writeln( List );Writeln( list); 
If  last  rank  =  size  then 
Writeln( list ,' The  system  is  observable  with 

index  ' ,value2 , '  .'); 
If  (value2  >=  size  )  and  (last_rank  <  size)  then 
Writeln  (list,  'The  system  is  unobservable .  '); 
writeln( list );writeln( list); 
Close( list ) ; 
End; 
Until  Ch  in  [ 'Q' , 'q'  ] ; 

Assign( SvsFile , 'svs.COM' ); 

(re-execute  SVS  main  program) 
Execute( SvsFile ) ; 
End. 
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Program  Luenberg  observer ( input , output ) ; 
<$I  Typedef.SYS}- 

{$i  Ut-mod01 . INC} 
{$1  Ut-mod02.inc> 

label  940;label  960;label  22;label  28;   label  950; 


Type 


Var 


aryl 
ary2 
ary3 
ary4 
ary6 


array 
array 
array 
array 
array 


f1  •  -lg] 

.1  .  .30, 

.1  .  .30. 

.1  .  .  1  1  . 

[1  . . 1  1  J 

of  real: 
1  .  .30J  of 
of  real; 
of  real; 
of  intege 


real ; 


> 

er 


rrl  . rim, ooo , oooo 

i,NRl,l  ,mm,nrm.nrp , ixx, jxx 

nrn.nr ,r , rp ,k  , t , o ,umran , ii 

code , vertpos ,honzpos ,poscouh 

h ,  a.1  ,  e 

coeff,coef, desired  feedback 

f  - 

beta,x 

hi  .u 

ist 

strg , exponent 
change 

specification 

Realpartvalue , imaginarypartvalue 
temp , inputtype 


one 


? 


real ; 


integer ; 
aryl  ; 
ary4; 
aryl s  • 
ary3; 
ary2; 
text; 

string[2] ; 
boolean; 
string[5] ; 
ary3s; 
char  ; 


($1  Ut-mod03. inc) 

{$1  Luenberg. inc > 

{$1  Pole. inc) 
(SI  Rootf ind. inc) 
($1  Boxuser.inc) 

Begin 

ClrScr;  luen : =true ; one : = 1 ; 
for  i:=1  to  size  do 
for  _1 :  =  1  to  1 _  do 


>rl:  =  1  to  Id 

E[i1:=Bri,l]; 
)xy(1  ,22); 


gotoxyv ■ , 
invvideo( ' Press 
gotoxyC 1 ,23); 


<ESC>  to  change  it! 


Parameters  ***'); 


I 


'); 
'); 


***  Luenberger  Observer  Design 


invvideo( 'Then  type  your  input  with  <ENTER>  key 
gotoxy( 1,1);  Textcolor ( lightblue^ ; 
wr iteln( '         * " 

Parameter 
TextColor (yellow) ; 
writeln(  '=  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  ='); 

TextColor (yellow) ; 

msg( ' Input  degree  of  observer   (  10  max)'  ,1,5); 

R  A  T"^  ft  ^  "t" 

input ( 'N» , '  ' ,40, 5, 3, true, F1 ,F10); 

val( answer , r , code)  ; 

if  (r  >  10)  and  (  r  <  1  )  then  beep( 900 , 350 ) ; 
until  (r  <=  10)  and  (r  >  0); 
rp  :  =r  +  1 ; 
msg( ' Input  the  Desired  Feedback  Coefficients  in 

,  Factored  <F>  Form  ',1,7); 
msg( '  or  Coefficient  <C>  Form  ',1,8); 

r  eT5  e  at 

Input ( 'A' ,'C ,64,7.2.true,F1 ,F10); 

temp : =copy ( answer ,1,1); 
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if  not  (tempin  ['F'  '  C  '  ]  )  then  beep( 900 , 350  ) ; 
until  temp  in  ['F','C'J; 
inputtype : =temp ; 

Case  inputtype  of 
'F ' :begin 

if  change  then 

for  i:=1  to  size  do 

begin 

str(realpartvalue[i] :8:  2.,Filvar  [2*i+9] ) ; 
str ( imaginarypartvalue [i 1:8 : 2 , „ 

Filvar [2*i+1 0] ); 
end; 

input_Factored( 'POLES' , size ,RealPartvalue . 

ImaginaryPartvalue ) ; 
endj 
'  C '  :begm 

if  change  then 

for  i:=  1  to  size-1   do 

begin 

str(Desired  f eedback[size-1 -i] :8 : 2 , 

—  Filvar [size+22-i] ) ; 

end; 

input_coef( 'POLES' , size-1 ,Desired_f eedback ) ; 
end; 
end; ClrScr ; Writ eln: got oxy( 1 , 22 ) ; 

invvideo( ' Press  <ESC>  to  change  it!,  '); 

gotoxy( 1 . 23 ) ; 

invvideo( ' Then  type  your  input  with  <ENTER>  key   '); 
gotoxyC 1,1);  TextColor ( lightblue ) ; 
Writeln('  ***  Luenberger  Observer  Design 

Input  Parameters  ***'); 
textcolor (yellow) ; 
writeln(  '=  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  =  ='  ); 

t ext c o 1 or ( gr e en ) * 

msg( ' Input  observer  characteristic  polynomial 

Factored  (F)  Form  ',1,5);  „ 
msg( '  or  Coefficient  (C)  Form  ',1,6); 

input ( 'A' , 'C' ,65, 5, 2, true, F1 ,F10); 

temp:=  copy (  answer  ,1  ,  1  ):. 

if  not  (temp^in  C'F'  'C*])  then  beep( 900 , 350  ) ; 
until  temp  in  ['F','C'J; 
if  temp  =  'C  then   goto  950; 

if  change  then 

for  i:=1  to  r  do 

begin   ,  _  _  _ 

str (realpart value [i] :8: 2^ Filvar [2* i+?l ) J 

str ( imaginarypartvalue [i J :8: 2 , Filvar [2*i+10] ); 

end; 

input  Factored! 'POLES' , r ,RealPartvalue , 

ImaginaryPartvalue ) ; 

Polynomial  of  roots( r ,Realpartvalue , 

Imaginarypartvalue ,coef) ;  GoTo  960; 

950: if  change  then 
for  i:=  1  to  r  do 
begin   #  _       _ . 

str(coef [r-i] :8: 2 , Filvar [r+22-i] ) ; 
end; 

input_coef f (  ' POLES '  , r , coef  ) ; 

root  finder (r , coef , realpartvalue , 

imaginarypartvalue , one ) ; 
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ClrScr; Writeln; Writeln; 

Writeln( ' The  observer  eigenvalues  are  :  '): 

WritelnC '    REAL  PART  IMAGINARY  PART'); 


for  i : =    to  r  do 
Begin 


write( '    ' , realpartvalueTi] : 1 0 , '      + 
imaginarypartvalue[i J :  1  0 , r  j  ');  Writeln; 


> 

» 


End, 

Writeln: Writeln; 

Writeln(' The  Observer  characteristic  polynomial 

coefficints  in  ascending  powers  of  S'); 
Writeln; 

for  i : =1  to  rp  do 
Begin        „  _ 

Write(coef [i] :  1  0  '   ' ) ; 
End;  Writeln; Writeln : 

960:KEYREAD(KEY,KEYOLD,NOT  ERASED) ;ClrScr ; 
for  i:=  1  to  30  do         ~ 
Begin 

for  1:=  1  to  30  do 

Beginr 

PHI[i,l]  :=0.0; 

End; 
End; 

for  i : =  1  tor  do 
Begin. 

HLi]  :  =  0.0; 
End: 

H[1 J :=1 .0: 
for  i  : =  1  to  r  do 
Begin 

for  1 : =  1  tor  do 

Begin 

_  F[i,l]:=  0.0; 

End; 

F 

i 

F 
28: End; 

for  i:=1  to  20  do 
be 


FT! , 1 ]  :=  -COEF[rp-il; 

i:^  i  =  r  then  goto  28; 

F  i,i+1]  :=  1 .&; 

:End; 

r  i:=1  to  20 

gin  ^_ 

BETAtiJ :=0.0; 


End; 

nr  : =  size  *  r ; 

for  i : =  1  to  nr  do 

Begin 

BETA[i]  :=  0.0; 
End; 

nrp  : =  nr+1 ; 
nrn  :=  nr  +sizej 
for  i  :=  1  to  size  do 
Begin  _  _  _ 

BETA[nr+i]  :=  desired  feedback[i] ; 
End;  ~ 

for  i  :=  1  to  r  do 
Begin 

ii:=  size*(i-1 ); 

for  1 : =  1  to  r  do 

Begin 

Jd  :=  size  *  (1-1  ) ; 
for  k:=  1  to  size  do 
Begin 

PHI[ii+k,jJ+k]  :=  -F[i,l]; 
End; 

End; 
End; 
for  ii : =  1  to  r  do 
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Begin 

1 : =( ii-1 )  *  size; 

for  1:=  1  to  size  do 

Begin 

for  k:=  1  to  size  do 
Begin,. 

PHI[i+l,i+k]  :=  PHI[i+l,i+k]+  A1A[k,l] ; 
End; 
End; 
End; 

for   ii:=  1  to  r  do 
Begin 

l  :  =  size  *  (  n-1  )  ; 
for  1:=  1  to  size  do 
Begin_ 

PHI[nr+l, i+1]  :=  H[ii]; 
End; 
End; 

for  i:=  1  to  size  do 
Begin 

for  1 : =  1  to  no  do 
Beginr 

PHI [nr+i ,nr+l]  :=  C[l,iJ; 
End; 
End; 

nrm  :=  nr  +no ; 
for  ii:=  1  to  r  do 
Begin 

l  :  =  size  *  (  n-1  )  j 
t:=  nrm  +  no   *(n-1); 
for  k:=  1  to  no  do 
Begin 

for  s:=  1  to  size  do 
Begin_ 

PHI[i+s,t+k]  :=  -C[k,s]; 
End; 
End; 
End; 
mm:=  r*  (size+no)  +  no; 

Boxuser ; 

Text Col or ( white) ; 

1 inear _e  quat  i  on ( PH I , NRN , MM , BETA , X , K , U ) ; 

for  ii : =  1  to  r  do 
Begin 

i : =  size  *  ( ii-1  ) ; 

AJ[iiJ  :=  0.0; 

for  o  :=  1  to  size  do 

Begin 

AJ[ii] :=AJ[ii]  +E[o]  *X[i+o]; 

End; 
End; 

nr 1  : =  nr  +  1 ; 

ClrScr ;Writeln;Wr iteln j textcolor ( yellow) ; 
Writeln('The  F  Matrix  is  :  ');Wnteln; 
for  i : =  1  to  r  do 
Begin 

for  o:=1  to  r  do 

Begin 

Write(  '   '  ,F[i,o] :1 1  ); 

End; Writeln; 
End; 

KEYREAD(KEY,KEYOLD,NOT  ERASED);  ClrScr j Writeln : 
textcolor (yellow) ;Writeln( ' The  G1  Matrix  is  :  '); 
Writeln; 
for   ii : =  1  to  r  do 
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Begin 

i:=  no  *(ii-1)  +  nrm; 

for  o:=  1  to  no  do 

Begin 

Write(  '   '  ,X[o+i] : 1 1  )  ; 

End; Writeln; 
End: wr iteln ; writeln ; 

Writeln  ('The  G2  Matrix  is  :  ») .Writeln; 
for  i  : =  1  to  r  do 
Begin     t  _  _ 

Writeln( •   ' ,AJ[i] : 1 1 ) ; 
End; 

KEYREAD( KEY , KEYOLD , NOT  ERASED ) : 
ClrScr ; text col or (yellow) ; Writeln; 
Writeln  ('The  output  feedback  coefficients  are 
(  Ascending  powers  of  S  )  :');Writeln; 
for  o : =  nr 1  to  nrm  do 
Begin   ,       _  _ 

Write(  '   '  ,X[o] :1 1  )  ; 
End: Writeln; writeln; 
Writeln('The  compensator  feedback  coefficients  are 

(ascending  powers  of  S  )  :'); 
writelnjfor  i:=  1  to  r  do 
Begin 

Write( '   ' ,H[i] : 1 1 ); 
End; 
KEYREAD( KEY , KEYOLD , NOT_ERASED ) ; 

Repeat  , 

Box  printer ; text col or (yellow) ;gotoxy( 58, 1 5 ) ; 

write( ' "LUENBERG.RES"   '); 

gotoxy( 1 .25 ) :write( *  '); 

Re  ad ( ku  d  ch ) * 

if  (ch='P')  or  (ch='p')  or  (ch='F')  or  (ch='f)  then 

Begin 

if  (ch='F')  or  (ch='f)  then 
Begin 

gotoxy( 45 , 1 5 ) ; Textcolor ( red) ; 

write(  ^PRiNTING '); 

Assign( list . ' luenberg.RES ' ) ; 

Rewrite! list ) ; 
End; 

if  (ch=,P')  or  (ch='p')  then 
Begin 

gotoxy( 45 , 1 3 ) ; text col or ( red) ; 

write('  PRINTING '); 

Assign(list, ' LST : ' ); 

Rewrites  list ) ; 
End; 

Writeln(list , 'LUENBERGER  OBSERVER  RESULT  '); 
For  i:=1  to  2  do  wr iteln( list ) ; 
Writelnt list ,' The  plant  matrix  A  is  :  '); 
WritelnC list) ; 
for  i:=1  to  size  do 
Begin 

for  1:=1  to  size  do 

Begin 

Write  list,'   ' , A1 A[i , 1] : 1 1 ) ; 

End;Writeln( list ) ; 
End;Writeln( list ) ; 

Writelni list .' The  input  matrix  B  is  :')  ; 
Writelnl list ) : 
for  i:=1  to  size  do 
Begin 

for  1:=1  to  1  do 
Begin 

Write(list, '   ' ,B[i,l] : 1 1 ); 
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End; WritelnC list ) ; 
End;Writeln(list ) ; 

WritelnC list . 'The   output  Matrix  C  is:'); 
WritelnC list ) ; 
for  i:=  1  to  no  do 
Begin 

for  1:=1  to  size  do 

Begin 

WriteClist, ;   '  C[i,l]:11 ); 

End;wnteln( list ) ; 
End;Writeln(list ) ; 
WritelnC list , 'The  desired  feedback  coefficients 

are  :  ' ) ; Writeln( list ) ; 
for  i:=1  to  size  do 
Begin 

for  1:=1  to  1  do 

Begin 

WriteClist,'   ', desired  f eedback[i] : 1 1 ) ; 

End;Writeln(iist);        ~ 
End; Writeln (list) ; 

Writeln( list ,' The  observer  eigenvalues  are  :  '); 
WritelnC list , 'REAL  PART  IMAGINARY  PART'); 

for  i : =  1  tor  do 
Begin 

Write( list , '  '  , realyar tvalue [i] :  1  0 , '   +       ' 

imaginarypartvalue[i] : 1 0 , '  j    ' ) ;  WritelnC list ) ; 
End; WritelnC list ) ; 

WritelnC list ,' The  Observer  characteristic 
polynomial  coefficints  in  ascending  powers  of  S'); 

WritelnC list ) ; 
i  :  =  1 


for  i : = 1  to  rp  do 
Begin 


WriteClist,'   ' , coef Til : 1 1 ) : 
End; WritelnC list);  writeln(list): 
WritelnC list ,' The  F  Matrix  is  :  ' 


) ;Writeln(list); 


for  i : =  1  to  r  do 
Begin 

for  o:=1  to  r  do 

Begin 

WriteClist  '   ' ,F[i ,o] : 1 1 ) ; 

End;Writeln(list) ; 
End;Writeln(list); 

WritelnC list . 'The  G1  Matrix  is  :  '); WritelnC list ) ; 
for   ii:=  1  to  r  do 
Begin 

i:=  no  *(ii-1 )  +  nrm; 

for  o:=  1  to  no  do 

Begin 

WriteClist  '   '  X[o+i]:11); 

End; WritelnC list ) ; 
End:Writeln(list ) ; 
Writeln  (list, 'The  G2  Matrix  is  :  '); WritelnC list ) ; 

for  i  :=  1  to  r  do 
Begin  # 

WritelnClist, '   ' , AJ [i] : 1 1 ) ; 
End; WritelnC list ) ; 
Writeln  (list, 'The  output  feedback  coefficients 

are  : ' ) ;Writeln( list ) ; 
for  o:=  nr1  to  nrm  do 
Begin 

WriteClist, ' N  ' ,X[ol :11 );  x 
End; WritelnC list );writeln( list); 
WritelnC list ,' The  compensator  feedback 

coefficients  are  :'); WritelnC list ) ; 
for  i : =  1  to  r  do 
Begin 
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Write(list, '   » ,H[i] : 1 1 ); 
End; 

for  i:=1  to  3  do  wr iteln( list ) ; 
Close( list ) ; 
End; 


Until  ch  in  £ 'Q» , 'q' 1 ; 
Assign( SvsFile , 'svs.COlYr ); 
Execute( SvsFile ) ; 
End. 
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urogram  optimal , control ( input , output ) ; 
•SI  Typedef .  sys) 

!I  Graphix.sys) 

!I  Kernel .  sys  ) 

II  Windows  .  sys  } 

[I    Polygon. hgh) 

»I  Axis,  hgh) 

{$1  Ut-mod01 . INC}     {  I/O  procedures) 
($1  Ut-mod02.INC> 
{$1  Ut-mod03. inc) 

($1  Grapmenu. inc ) 
{$1  Boxuser.inc) 
label  2; label  3; 
const 

xarray  :  string[l4]  = 'TIME  INTERVALS'; 
var 

GTNY   :  array  [1..80]  of  real; 

GTN    :  array  [ 1 . . 1 0 , 1 . . 80]  of  real; 

PSI ,P1 ,D3,D4,FI ,Q, gamma     :ary1s; 

D2,D1 ,GT  :ary3s; 

ti , i , j , 1 ,nterm,kk , code      '.integer; 

y , ymax,ymin , r , denominator , negatir , si, re suit  :real; 

Srapharray ,grapharray1      rplotarray ; 
umpgraph , quit         : boolean; 
list  :text; 

ans  :char; 

{$1  Optimal. inc) 

Procedure  PrintGraphData; 

{this  procedure  dumps  optimal  result  data  to  printer) 

Begin 

LeaveGraphic ; Clrscr :  Textcolor (yellow) ; 
Center('^**  PROGAM  OUTPUT  OPTIONS  *  *  * <  , 1  , 1 0 ,80  )  ; 
Text Co lor (green ); 

msg! ' Press  <P>  Print  results  to  the  printer  ',1,12); 
msg( '       <F>  List  results  to  file  name 

"OPTIMAL. RES"  on  the  current  dr ive '  , 1  , 1 3  )  ; 
msg( '       <Q>  Quit  ',1,14); 
repeat 

Read(kbd,ch) :     ,         v 

If  (ch  =  'F()  or  (ch  =  'f')  or  ( ch  =  'p') 

or  (ch  =  ' P' )  then 
beginy 

if  (ch  =  'F')  or  ( ch  =  'f')  then 
begin 

Assign( list . ' Optimal .RES' ) ; 
Rewrites  list ) ; 
end 
else 
begin 

assign(list , 'LST: ' ) ; 
rewrite! list ) ; 
end: 

Writeln(list ) ; 
wr ite( list )  * 

writelnf list  'OPTIMAL  CONTROL  RESULT  '); 
writelm list )  ; 

write! list ,' The  order  of  the  system  is:'); 
writeln( list , size : 2 ) ; 

write! list ,' The  number  of  time  intervals  is:'); 
writeinf list , si : 2 ) ; 
write! list ,' The  scaler  R  is:'); 
writeln(list,r:7:4); 
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write( list ,' The  sample  interval  is:'); 

writelni list .  ti : 4) ; 

writelni list ) : 

writeln( list ,  The  A  matrix  is : ' ) ; writeln( list ) ; 

for  1:=  1  to  size  do 

"begin 

for  j : =  1  to  size  do 

begin 

write(list,'   ' , A1 A[l ,3 ] : 1 1 ) ; 

end; writelni list ) ; 
end:  writeln( list ) ; 

writeln( list ,' The  B  matrix  is : ' ) ;wr iteln( list ) ; 
for  1:=  1  to  size  do 
begin 

for  3  :  =  1  to  ni  do 

begin 

write(list, '   ' ,B[l,j]:11 ); 

end; writ eln( list ) ; 
end;  wr iteln( list ) ; 

writeln( list ,' The  Q  matrix  is : ' ) ;wr iteln( list ) ; 
for  1  : =  1  to  size  do 
begin 

for  j:=  1  to  size  do 

begin 

writeQist,  '   '  ,Q[l,j]:11  ); 

end; writelni list ) ; 
end:  writeln( list ) ; 

writeln( list ,' The  FI  matrix  is : ' ) ;writeln( list ) ; 
for  1:=  1  to  size  do 
begin 

for  3:=  1  to  size  do 

begin    ,  _ 

^write(list? '   » ,FI[1,3]:11 ); 

end; writelni list ) ; 
end:  wr iteln( list ) ; 

writelni list .' The  GAMMA  matrixis:'); 
wr  iteln( list ) ; 
for  1:=  1  to  size  do 
begin 

for  3 : =  1  to  ni  do 

begin 

write(list  '   ' ,GAMMA[1 , j ] : 1 1 ) ; 

end; writelni  list) ; 
end;  wr iteln( list ) ; 

writeln( list  'MINIMIZATION  OVER  ALL  STAGES  '); 

writeln( list ) ; 

write( list , 'N  (stages)'); 

for  1 : =1  to  i  do 

write(list,'     GAIN:',!,'   '); 


iteln(list); 

ite(list,' '); 


wr 
wr 
for  1:=1  to  i  do 

write(  list ,  '  '); 

writeln( list); 

for  j : =  1  to  ti  do 

begin 

write(list , '   '  , j  :  2 , '      '  ); 

for  1 : =1  to  i  do 

begin  _    _ 

write(list.'    ',  graphArr ay 1  [j  » 1 J  :  1 0  )  J 

end; writeln( list)  ; 
end; 

until'ch  in  [ ' F ' , ' f ' , ' Q ' , ' q ' , ' P ' , ' p ' ] ; 
EnterGraphic ; 
swapscreen ; 
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begin 

clrscr ; Text Col or ( lightblue ) ; 

writeln('      ***  Design  of  Optimal  Control 

, procedure  ***'); 
Textcolor (yellow) ; 
writelm  '===================================: 

gotoXY(1  ,25) ; InvVideo(  ' Press  <ESC>  to  change 
Then  Type  vour  input  with  <ENTER>  key'); 
TextColor (green) ; 
Msg( ' Input  number  of  time  intervals  for  SUM 

procedure?  (  MAX  99  )  ',1,4 
input ( 'N' , '50' ,65,4, 6, true, F1 ,F10 
val ( answer ,  ti  , code ) ; 
Msg('What  is  your  sample  interval?  ',1,6); 
input ( 'N' , '0. 1 ' ,35, 6, 6, true, F1 ,F10) ; 
val ( answer , si , code ) : 

Msg( 'What  is  the  value  of  scalar  R  ?  ',1,8); 
Input ( 'N' , '0.0' ,35,8, 6, true, F1 ,F10) ; 
val ( answer , r , code ) ; 

Msg('For  the  following  options  Which  cost 
function  do  you  want  ?  ',1,10); 


it! 


); 


TextColor ( lightmagenta 
:(  '  COST  =  terminal+fue 


+trajectory  or 

COST=terminal+traiectory   <0>',1 

'COST=terminal+fuel  or 

COST=terminal  <1>',1 

"  ,1 


'Where 

> 
i 
i 
i 
i 
> 


OO  1  WJ.lia.-L  ^     I     S  ,   I   ,   I  I-    )    , 

13); textcolor (yellow ) : 

,1,14);  textcolor ( lightmagent 


Terminal  =  1/2 
Traj  ectory  =  1 /2 


T 
X  (N) 


Msg( 

Msg( 

msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 
msgi 

Input ( 'N' , '0' ,65, 10,2.true,F1 ,F10) 
val( answer ,nterm,code) jclrscr; 
writeln( ' enter  the  element  of  Q 
for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

be- 


11); 
12) 


Q  X(N) 


Fuel  =  1/2 


N-1   T/    X 

X  (k)  Q  X(k) 


R  U  (k) 


N-1  T,  x 
U  (k) 


matrix: 


r 
wr 


wr 


liel 'Q( ' ) jwrite(i) :write( ' 
ite('J=  i  ) ;readln(Q[i,3l) ; 


) ;write( j ) ; 


) ;  wr iteln; 


wr 
J=  ');r 
end; wr iteln; 
end; 
Repeat 

ClrScr;  Writeln; 
Writeln('The  Q  Matrix  is 
for  i  :=1  to  size  do 
Begin 

for  j  :=  1  to  size  do 
Begin   ,        _ 

Write( '   ' ,  Q[i,j] :1 1 ); 
End;  Writeln; 
End:  writeln; 
Write('Do  you  want  to  change 

the  Matrix  ?  (  Y  /  N 
Read(Kbd. Ans) ;  writeln;  , 

(allows  user  to  change  entered  data  ) 


any  element 
)  '  ); 


of 
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if  (  Ans   =  'Y')  or  (  Ans  ='y')  then 
Begin 

writeC ' Input  the  row  to  change  :  ');  readln( i ) ; 
write( ' Input  the  column  to  change  :  '); 
readln  i ) .-writeln; 

write()Q(5,i.',',j,')=  ' ) ; readln ( result ) ; 
Q[i  f J  J ' =result ; 
End; 
Until  Ans  in  C'N'.'n']; 
text co lor (white ) ; 
Boxuser  * 
F I_and_6AMMA ( S I , F I , GAMMA ) : 

{  call  procedure  to  calculate  fi  and 

gamma  matrices  ) 
TextColor ( yellow) ;  clrscr; 
writelm'Tne  FI  matrix  is  :  ')j 
for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 
begin 

write( '   ' ,FI[i,J] :11 ); 
end; wr itein; 
end; wr iteln; wr iteln; 
writelni'The  gamma  matrix  is:  '); 
for  i:=1  to  size  do 
begin 

for  j : =1  to  ni  do 
begin 

writeC   '  ,GAMMA[i,  j  ]  :1  1  ); 
end; wr iteln; 
end; writeln; writeln; 
keyread(key ,keyold,not_erased) ; 
Boxuser ; 

for  i:=1  to  size  do 
begin  _ 

=  0.0; 
=  0.0; 
=1  to  size  do 


D2 

for  J 
be" 


=  0.0; 
=  0.0; 


D4 
P 
end; 
end; 

y : =  0 . 0 ; ymax : =  0 . 0 ; ymin : =  0 . 0 ; 
for  kk:=1  to  TI  do 
begin 

denominator : =0 . 0 ; 
for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

6§t?i] :=D1 [i]  +  GAMMA [ j ,1]  *  Pl[j,i]; 

end; 
end; 

for  i:=1  to  size  do 
begin 

for  j : = 1  to  size  do 

begin  _     _  _      _  _      _ 

D2[i]:=D2[i]    +    D1[d]     *    FI[j,i]; 

end; 

denominator : =denominator  +  D1 [i]  *  GAMMA[i,1J; 
end; 

denominator : =denominator+  R; 
negatif : =-1 . 0 : 
for  i:=1  to  size  do 


bey 


}T[i]:=  negatif  *  D2[i]  /  denominator; 
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to  size  do 
to  size  do 


+  GAMMA [ i , 1 ]  *  GT[j]  ; 


GTN[I,KK] :=GT[I] ; 
•   D1II. :=0.0; 

D2[i] :=0.0; 
end; 

for  i:=1 
begin 

for  rj  :  =  1 

begin,. 

|SI[i,j]:=FI[i,d] 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j  : =1  to  size  do 
begin 

for  1:=1  to  size  do 

ef3?i,j] :=D3[i,j]  +  PSI[l,i] 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 
begin 

for  1:=1  to  size  do 

e84?i,j] :=D4[i,j]  +D3[i,l]  * 
end; 
if  nterm  <=_ 0  then 

3:D4[i,j] :=0.0;  ' 

end; 
end; 

for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

begin 

B3[i,j] :=0.0; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

for  j : = 1  to   ti  do 
begin 

GTNY[Jl :=GTN[I, Jl ;  _  _ 

if  abs(y)  <  T.0e07  then  y:=GTNY[i1 

else  y : =  1 . 0e07  ; 


*  P1 [i,dl; 


psi[i,j]; 


goto  2:  „ 
8  *  GTfi]  ' 
+   Q[i,jJ  + 


R 


GT[ 


4itif 


oto  3; 


if  y  >  Ymax  then  Ymax:=y; 
Y  <  Ymin  then  Ymin:=Y; 

=    J  J 

=  y; 
=  y; 


if  Y   < 

Grapharray  LI  ,  1  . 
gr  aphar  r  ay [ l , 2  J 

grapharray!  [3,1] 
; 
Ymax : =    1.2    *    Ymax ; 


initgraphic ; 
selectwindow( 1 ) ; 

gotoxyC  4 , 4 ) ;write(  'G' 
gotoxy( 4 , 5 ) ;write( 'A' 
gotoxyi 4 , 6  )  ;write( 'I' 
gotoxy( 4 , 7  )  ;write(  '  N' 
gotoxy( 3,9);write(i:2 
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Selectwindow( windowndxglb ) , 
Drawpolygon(grapharray , 1  , -( ti-1  ), 0,0,0); 

repeat  until  keypressed; 

quit : =f alse; 

repeat 

Graph_menu(  'OPTIMAL  CONTROL  GAIN 

PLOT ' , dumpgr aph , quit ) ; 

if  dumpgr aph  then  pr intgraphdata; 
until  quit| 
leavegraphic ; 
end; 

Assign(SvsFile, ' svs .COM' ) ; 
Execute ( SvsFile ) ; 
end. 
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program  pole_placement ( input , output ) ; 

($1  Typedef . sys) %  (comman  type  &  variable  definitions} 
($1  Ut-mod01  .  mc  } 
($1  Ut-mod02. inc) 


label  100;label  110;label  120:label  130;label  140: 
label  150;  label  160; label  170; label  180; label  190; 
label  200;label  210; 

"type 

ary6  =  array  L1..21]  of  integer; 

ary4  =  array  [1..11]  of  real; 

var 

AA,PIN,P10  :ary1s; 

CCC  :ary4; 

CC,H,DEN,E,HH  : ary4 ; 
r ealpart , imaginarypart . real_part , 
imaginary_part , r ealr oot . imaginaryr oot , 

realparti , imaginarypart 1  :ary3s; 
nn.umran.i..]  ,3],k,l,n2,n1,m  ,er  , 

vertpos , nor izpos ,  poscounter , code  : integer ; 

gainl.test  :real; 

input2  : char ; 

exponent , strg  :string[2J; 

Change , factored  :boolean;_ 

specification  :string[5j; 

inputfile  :file; 

reduceorder ,msize , one  : integer ; 

list  :text; 

Ut-mod03 . inc } 
Pole . inc  } 
Polynom. inc  > 
Inverse . inc  > 
Rootf ind. inc } 
Boxuser . inc } 

begin   {  open-loop  calculations) 

nn :=size  +  1  :  Boxuser ; luen : =f alse ; one :  =  1  ; 
CHARACTERISTIC_EQUATI0N( A1 A , SIZE , DEN ) : 

(call  polynom. inc) 
clrscr ; TextColor (yellow) ; 
writeln( 'Denominator   of  Y(s)/U(s)  :'); 
vertpos : =2 ; 
for  i : =nn  downto  1  do 
begin 

j : =nn-i ; 

Soscounter:=(j  mod  4)  +1 ; 
or izpos : =poscounter *1 4 ; 
if  poscounter  =  1  then  vertpos :=  vertpos+2; 
if  i  <>  1  then 
begin 

gotoXY (hoc izpos -1 0 , vertpos ) ; 

write(.DEN[iJ  :  7  :  4  )  ;         ' 

msg('S  +' ,horizpos , vertpos ) ;  str( i-1 : 2 , exponent ) ; 

msg( exponent ,horizpos+1 ,vertpos-1 ); 
end 
else 
begin 

§otoXY(hor izpos- 1 0 , vertpos) ; write (DEN [i] :7:4) ; 
; 
end;wr iteln;writeln; write In; write In; 

root_finder( size , den , realpartl , imaginarypart 1 , one ) ; 
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writeln('The  poles  of  the  Y(s)/U(s)  are:'): 

writeC '  REAL  PART'); 

writelnf '         IMAGINARY  PART  »); 

for  i:=1  to  size  do 

begin 

writel  '         __  '); 

wr ite(  realpartl [i] : 7 : 4} ; _write(  '       +j      '  ); 

writeln( imaginarypart 1 [l J :7:4 ) ; 
end; 

keyread(key , keyold,not_erased) ;  clrscr ; 

for  i:  =  1  to  size  do, 
P1 0[i ,size] :=B[i , 1 ] ; 

for  j  j  :  =  2  to  size  do 
begin 

for  i:=1  to  size  do 

begin 

for  l;=i  to  sizedo  _      _  _ 

P10ti,jJ:=    P10[i,d]    +A1A[i,l]    *    P10[l,k]; 

end; 
end; 

for  i:=1  to  size  do 
begin  _ 

CC[i] :=0.0; 

for    i:-1    to    size    do  _    _ 

CC[i]:=    P10[3,iJ    *    C[1,J]    +    CC[i]; 
end; 

for  i:=1  to  size  do 
begin 

m: =nn-i : 

if  CC[m]  <>  0.0  then  goto  100; 
end; 

1 00 : Text col or (yellow) ; 

writeln( 'Numerator  of  Y(s)/U(s)  :'); 
vertpos : =2 ; 
for  i : =  m  downto  1  do 
begin 

j :=  m  -  i ; 

poscounter :  =  ( j  mod  4)  +1  ;horizpos : =poscounter *  1 4 ; 

if  poscounter  =  1  then  vertpos :=  vertpos+2; 

if  i  <>  1  then 

begin 

gotoXY(horizpos-1 0 , vertpos ) ; write ( CC[i J :7 :4 ) ; 
msg('S  +' ,horizpos , vertpos ) ;  str ( i-1 : 2 , exponent ) ; 

msg( exponent ,horizpos+1 ,vertpos-1 ); 
end 
else 
begin 

§otoXY( hor izpos-1 0 , vertpos );write(cc[i] :7:4); 
; 
end;writeln;writeln;writeln;writeln; 
msize : =m-1 ; 

root_f inder (msize , CC , real root , imaginary root , one ) ; 

writeln('The  zeros  of  the  Y(s)/U(s)  are:'): 

writef  '  REAL  PART'  ) ; 

writeln( '  IMAGINARY  PART  '); 

for  i:=1  to  msize  do 

begin 

write(  '  ' ) ; 

writej realroot [i] :7 : 4 ) : _wr ite( '       +j      '); 

wr iteln( imaginary root [i J :7:4 ) ; 
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end; 

keyread(key ,keyold,not_erased) ;clrscr ; 

m: =m-1 ; 

clrscr  ; text col or (green ) ;highvideo; 

msg( ' Input  the  desired  closed-loop  characteristic 

,  equation  '1 ,  6  )  ; 
msg( 'Factored  (F)  form  or  Coefficient  (C) 
form  ?' ,1 ,7); 

repeat  read(kbd, input2 ) 

until  input2  in  [ 'F ' , » f ' , » C '  » c ' 1 : 

if  (input2  =  'F')  or   (  input2=  '  f  i  )  then 

begin 

if  change  then 

for  j : =1  to  size  do 

begin 

str(real  part [j ] : 1 0 : 2 , f ilvar [2*1  +9] ) ; 
str ( imaginarypart [j  J : 1 0 :2 , f ilvar [2*i+10] ); 
end; 

input_f actored( 'POLES' , size , real  part , 
Ann  imaginary  part); 

§oto  120; 

if  (input2='C)  or  (input2='c')  then 

clrscr ;m: =size+1 ; 

if  change  then 

for  j : =m  downto  1  do 

begin 

str(E[j] : 1 0:2,Filvar [size+22-j] ) ; 
end;umran : =1 : 
input_coef f ( ' POLES ' , size , e ) ; 

root_f inder ( size ,E, realpart , imaginary  p art , one ) ; 

clrscr  : 

write('The  roots  of  desired  closed-loop 

characteristic' ); 
writeln( '  polynomial  are:  '); 
writef'  REAL  PART'); 

writeln  '         IMAGINARY  PART  '); 
for  i:=1  to  size  do 
begin 

write! '         _  _  '); 

writeirealpart [i] :7:4) :  write( '       +j      '); 

writeln( imaginary_part [l J : 7 : 4 ) ; 
end; 

keyreadCkey , key old, not  erased) ; clrscr ; 
goto  180;  — 

120:for  i:=1  to  size  do 
begin 

for  j:=1  to  size  do 

begin 

AA[i,3] :=0.0; 

end; 
end; 
i  :  =0: 

1 60 : l : =i+1 ; 

if.imaeinary  part[ij  <>0.0  then  goto  150; 
AA[i , il : =real_part [l J :  goto  170; 
1 50: AAIi , ij : =real_part [il :    j : =i+1 ; 
AA.i,.-].  :  =-imaginary_part  [i  J  ; 
AA[ j , i J : =imasinary_part [i J ; 
i  :=."]1     AA[i  ,  i  J  :  =real  part[ij; 
170:if  (i-size)  <  0  then"  goto  160; 

CHARACTERISTIC_EQUATION(AA,SIZE,E); 
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180:for  i:=1  to  size  do 
begin_     _  _       _  _ 

H[i]:=  E[i]  -  DEN[i] ; 
end; 

for  i:=1  to  size  do 
beginr 

CCC[i] :=C[1 ,i]; 
end; 

INVERSE_FIND_MATRIX ( P1 0 , CCC , SIZE , PIN , CCC , ER ) ; 

for  i:*1  to  size  do 

e§H?i] :=0.0; 
for  j:=1  to  size  do 

e§H?i]:=    HH[i]    +    PIN[J,i]    *    H[j]; 

end; 
end; 

for  i:=1  to  size  do 
begin 

for    j:=i    to    size    do 

6SA?i,d]:=    A1A[i,j]    -    B[i,l]     *    HH[j]; 
end; 
end; 

CHARACTERISTIC_EQUATION( AA , SIZE , E ) ; 

if  CC[1]=0.0  then 
begin 

§ain1  :=1 .0;  goto  210; 

else 

gainl :=   E[1]  /  CC[1]  ; 

210:if  gainl  =0.0  then  gainl  :=1.0; 

textcolor (yellow) ; 

for  i:*1  to  size  do 

6§H?i]:=  HH[i]  /gainl; 
end; 

140:for  i:=1  to  size  do 
beginr 

HTi]  ;=H[i]/gain1  : 
end;if  H[size]:=0.0  then  reduceorder : =reduceorder-1  ; 
clrscr ;Writeln( 'Numerator  of  the  Heq(s)  is  :'); 
vertpos : =2 ; 

for  i:=  size  downto  1  do 
begin 

-ij=  size  i* 

poscounter : =(3  mod  4)  +1 ;horizpos : =poscounter *1 4 ; 
if  poscounter  =  1  then  vertpos:=  vertpos+2; 
if  i  0  1  then 
begin 

gotoXY(horizpos-1 0 , vertpos );write(H[il:7:4); 
msg('S  +' ,horizpos , vertpos ) ;  str( 1-1 : 2 , exponent ) ; 

msg( exponent ,horizpos  +  1  ,vertpos-1  ); 
end 
else 
begin 

§otoXY(horizpos-1 0 , vertpos ) ;write(H[i] :7:4)  ; 
; 
end; write In ;writeln;writeln; 
reduceorder : =size-1 ; 

root_f inder ( reduceorder , H , re alp art , 
imaginarypart 


,realp 

, one  )  ; 

Heq(  s 


wr iteln( ' The  roots  of  the  Heq(s)  are  :'); 
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writej '  REAL  PART'); 

writeln  '  IMAGINARY  PART  '); 

for  i:=1  to  reduceorder  do 
begin 

wntei  '  »  )  • 

writetrealpart [i] :7: 4) :  write( '       +1      '); 

writelnC  imaginarypart [l] :7:4) ; 
end; 

keyreadi key ,keyold,not  erased);  clrscr; 
n2 : =NN-1  ;  ~ 

190:if  H[n2]  <>  0.0  then  goto  200; 
n2:=n2-1 ;   goto  190; 
200 :n1 : =n2-1 ; 

TextColor (yellow) ;   gotoXY(1,2); 

writeln( 'The  feedback  coefficients    k    are  :  '); 
writeln;  for  i:=1  to  size  do 
begin 

write( '   ' ) ;write(HH[i] :7:4); 
end: writeln; writeln; 
write('The  gain  [  K  J  is  :'); 
writeln(gain1 : 7 : 4 ) ; wr iteln; 

keyread(key ,keyold,not  erased); 
Repeat  ~~ 

box  printer : text color (yellow) ;gotoxy( 58 , 1 5 ) ; 

write(  '"POL£.RES"  '); 

gotoxyi 1 .25 ) :write( '  '); 

gotoxy(49, 17) ; 

Read(Kbd, ch ) ; 

If  (ch='P')  or  (ch='p')  or  (ch='F')  or  (ch='f) 

then    Begin 

If  (ch='F')  or  (ch='f)  then 
Begin 

gotoxy( 45 , 1 5 ) ; text col or ( red) ; 

write(  Printing '); 

Assign(list, 'pole. res' ); 

(print  pole  placement  output  > 

Rewr ite( list ) ; ( to  file  on  the  current  drive) 
End; 

If  (ch='P')  or  (ch='p')  then 
Begin 

gotoxy( 45, 13) j text col or ( red) ; 

write( 'PRINTING. '); 

Assign(list, 'LST: ' ); 

(print  pole  placement  result  to  the  printer) 

Rewrite( list ) ; 
End: 

Writeln(list  '     POLE  PLACEMENT  RESULT   '); 
Writeln( list ):Writeln( list); 
Writelnt list .' The  Plant  matrix  A  is  :  '); 
wr iteln( list ) ; 
For  i  : =  1  to  size  do 
Begin 

For  j  : =  1  to  size  do 

Begin 

Write(List  '   '  A1 A[i , j ] : 1 1 ) ; 

End; Writeln ( list ) ; 
End; WritelnC list ) ;Writeln( list ) ; 
Writeln( list .' The  Input  matrix  B  is  :'); 
writeln( list )  ; 
For  i  : =  1  to  size  do 
Begin 

For  j  :=  1  to  ni  do 

Begin 

D  Write(List  '   '  , B[i , j ] : 1 1  ) ; 

End ; Writeln( li st ) ; 
End ;Writeln( list ) ; Wr iteln( list ); 
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WritelnC list ,  ' The  Output  Matrix  C  is  :'); 

wr iteln( list ) ; 

For  i  : =  1  to  no  do 

begin 

for  j : = 1  to  size  do 

begin 

Writedist.  '   '  ,C[i,j]  :11  ); 

end ;writeln( list ) ; 
end; Writ eln( List ) ;Writeln(list); 

writeC list , 'Denominator   of  Y(s)/U(s)  -'); 

wr itelnC list . '  Descending  powers  of  S:'); 

wr  iteln( list ) ; 

for  i:=nn  downto  1  do 

begin 

writedist'    '  ,DEN[i] : 7 : 4  )  : 

end:  writeln(  list  );writeln(lis"t)j 

writelni list ,' The  poles  of  the  Y(s)/U(s)  are:'); 

writeC list,'     REAL  PART'); 

writelnf list, '         IMAGINARY  PART  '); 

for  i:=1  to  size  do 

begin 

write  list , '  ' ) ; 

write(list ,realpart1 [i J :7 : 4 ) ; 

wr  iteClist  '       +1      ')* 

writelnflist, imaginarypart i  [i] : 7 : 4  ) ; 
end; writeln( list) ;writeln(list) ; 

writeC list ,' Numerator  of  Y(s)/U(s)  -'); 

writelntlist.'  Descending  powers  of  S:'); 

wr iteln( list ) ; 

for  i:=  m+1  downto  1  do 

begin 

writedist.  '   N  '  ,CC[i]  :7:4):  , 
end: writelnC list ) ;writeln( list ) ; 
writeln( list ,' The  zeros   of  the  Y(s)/U(s)  are:'); 

write (list,'  REAL  PART'); 

writelnjlist , '         IMAGINARY  PART  '); 

for  i:=1  to  msize  do 

begin 

writedist,  '        _  _  '  ); 

writetlist, real root [ij : 7 : 4 ) ; 

writedist,'       +3      ');. 

writelnC list, imaginary root [1  I  :7 : 4  ) ; 
end: wr iteln( list ); writ el n(list); 
write( list , 'Desired  closed-loop  Characteristic 

polynomial  ' ) ; 
writelnC list . ' -  Descending  powers  of  S  :'); 
writeln( list ) ; 
for  i:=  size+1  downto  1  do 
begin 

writedist  '    '  ,E[i]  :  7  :  4  )  ;  N 
end; writelnC list);writeln(list); 

write( list ,' The  roots  of  desired  closed-loop 

characteristic ' ) ; 
writeln( list , '  polynomial  are:  'J; 
writeC list,'  REAL  PART'); 

writelnf list , '         IMAGINARY  PART  '); 
for  i:=1  to  size  do 
begin 

writeC list ,  '  '  ) ; 

writeC list , real  part [i J :7 : 4  )  ; 

writedist,'    ~   +3      ')i  _ 

writelnC list, imaginarypart [i J : 7 :4 ) ; 
end;writeln(list);writeln(list); 
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Write( list , 'Numerator  of  the  Heq(s)  is  -'); 

writelm  list ,  '  Descending  powers  of  S  :'); 

wr iteln( list ) ; 

for  i:=  size  downto  1  do 

begin 

write(list?'    ' ,H[i] :7:4) : 
end; writ eln( list);writeln(list) 
writeln( list ,' The  roots  of  the  Heq(s)  are 
write 
write 

for  i:=1  to  reduceorder  do 
begin 

writeC list , ' 

writeClist ,realpart [i J :7 :4 ) ; 
write! list , '  +3  '  ) : 
write In (list, imaginarypart [11 :7 :4 ) 


■iteln(list) ;writeln(list): 
.n(list,'The  roots  of  the  Heq(s)  ar 
list, '  REAL  PART'); 

.nflist,'  IMAGINARY  PART  '); 


end; writeln( list); writ el nTlist): 

writeln( list ,' The  feedback  coefficients  [  k  J 

.  are  :  ' ) ; 
wr iteln( list ) ;  for  i:  =  1  to  size  do 
begin 

Mst.  ' 

_ln( li_ 
write( list ,' The  gain  [  K  J  is  :  ') 
writelnt list .gainl :7:4)j 
writeln( list );writeln( list) 


write( list , '   ' );write(list,HH[i]:7:4) 
end; writeln( list );writeln( list); 


Close( list ) ; 
End; 
Until  Ch  in  [ 'Q' , 'q'  ] ; 

Assign( SvsFile , ' svs .COM' ) ; 

(re-execute  SVS  main  program) 
Execute( SvsFile ) ; 
End. 
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( 


************************************************ 

TURBO  GRAPHIX  version  1.00A       * 

Type  definition  module  * 

Copyright  (C)  1985  by  * 

BORLAND  International  * 

************************************************ 


const  MaxWor ldsGlb=4 ; 
Maxorder =9 ; 
MaxWindowsGlb= 1 6 ; 
MaxPiesGlb=1  0; 
MaxPlotGlb=200; 
MaxBlocks  =10; 
StringSizeGlb=80; 
Header SizeGlb=1 0: 
RamScreenGlb :boolean=true ; 
CharFile:string[StringSizeGlb]= ' 4x6 . f on 
MaxProcsGlb=27 ; 
MaxErrsGlb=7; 
Extension : String [4] = ' . svs ' ; 


type 


var 


wrkstr ing=str in 
Wor ldType= record 
x1  ,y1 
end; 
WindowType= record 

x1 ,y1 ,x2 
header 


[StringSizeGlb] 
,x2 ,y2 :real ; 


drawn , top 


y2 : integer 
wr  kr ' 


:str  ing; 
boolean 


WorldType ; 
of _WindowType ; 
2]  of  real; 


of  character 


size : integer ; 
end; 
wor lds=array  [1 . .MaxWor ldsGlb J  or 
windows  =  array  [1 . .MaxWindowsGlb]  c 
PlotArray=array  .1 . .MaxPlotGlb , \  . . 
character=array  .1..3J  of  byte 
CharArray= array  [32.. 126] 
Pi eType= record 

area: real : 
text :wrkstring; 
end; 
PieArray=array  [ 1 . .MaxPiesGlb]  of  PieType; 
BackgroundArray= array  [0 . .7]  of  byte; 
LineStyleArray  =  array  [0M7]  .of  boolean; 


2. 


Ary1 s=Array 

Ary2s=Array 

Ary3s=Array 

Str2=String 

Str4=String[4~ 

Str5=String[5i 

Str20=Stringr 

Str25=string 

Str40=String 

Str80=String 

Str255=String 


10,1 
10.1.. 
1  0]  of 


10] 
10] 


of 

of 

real ; 


real 
integer 


20. 
25. 
40. 


X1WldGlb,X2WldGlb,Y1WldGlb,Y2WldGlb, 

AxGlb , AyGlb , BxGlb , ByGlb : real : 

X1Ref Gib ,X2RefGlb , YIRefGlb , Y2RefGlb : integer ; 

LinestyleGlb , MaxWor ldG lb ,MaxWindowGlb , 

WindowNdxGlb : integer ; 

X 1  Gib , X2Glb , Y1 Glb?Y2Glb : integer ; 

XTextGlb . YTextGlb , VStepGlb : integer ; 

PieGlb , DirectModeGlb , ClippingGlb , 

Axis Gib , HatchGlb : boolean : 

MessageGlb , BrkGlb , HeaderGlb , TopGlb , 

GrafModeGlb :boolean; 

CntGlb ,ColorGlb:byte; 

ErrCodeGlb:byte; 
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LineStyleArrayGlb :LineStyle Array; 

Error Proc : array  .0 . .MaxProcsGlb J  of  ~WrkString; 

ErrorCode : array. [0 . .MaxErrsGlb J  of  "WrkString; 


PcGlb:stringL40] , 

AspectGlb : real ; 

Graf Base : integer ; 

world: worlds ; 

windowl : windows; 

CharSet : Char Array ; 

D : Ary2s ; 

A1 A,B,C: Ary1 s; 

Len, Space , Dr ive : Str2 ; 

Size ,ni ,no , Block 1 ,Key .Keyold: Integer ; 

No t_e rased, Finished, Exit , Insert on, F1 ,F10: Boolean; 

ChrChar ; 

TemPlate .Answer , Previous  Answer : Str80 ; 

SvsFile:File;  "" 

P ,Filvar : Array [ 1 .. 35]  of  str40;  {menu  prompts) 

worldndxglb  : integer ; 

escape , retriev, luen  :  boolean; 
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procedure  Bodeplot; 

label  1;  {label  decleration  for  goto  statement) 

var 

Code , I , Count , NumberDecades , StartDecade , 

EndDecade  :  integer; 

Wf ,wo,Wi ,DeltaW.Gain  :  Real; 

PlotArrayl , PlotArray2 .MagPhase Array , 

FreqArray     :  PlotArray; 

ZMagn, Z Phase , PMagn , PPhase , Phase       :  real; 


TempX ,TempY 

temp 

OpenLoop 

.1 »  3  J  ,  kk1  , m,  1 ,  cnpoles  ,sizezeros,  one 

dencoef f ,numcoef f , cdencoef f 


real ; 

char  ; 

boolean; 

integer ; 

ary4; 
realpartpole , imagpartpole , realpartzero , 
imagpartzero , cr ealpartpole , cimagpar tpole :  ary3s ; 
PSI  :  aryls; 

function  Log( X : real ): real ; 

{computes  the  base-10  logarithm  of  X > 
Begin 

If  X=0  then  Log:=0  else 

Log  :=  Ln(X)/Ln( 10) ; 
End; 

function  Expon( Y, X : real ): real j 

{computes  Y  raised  to  X  power) 
Begin 

Expon  :=  exp(  X  *  (ln(Y))); 
end; 

begin 

ClrScr;  boxuser ;  one:=1: 

Characteristic  equation( A1 A, size , Dencoef f) ; 

for  i:  =  1  to  siz"e  do 

begin 

PSI[i, size] :=B[i,l] ; 
end; 

for  jj:=2  to  size  do 
begin 

for  i:=1  to  size  do 

begin 

f :=size-dd+1 J 

kk1  *  =  ~\  +1  • 

PSlti.d J :=Dencoeff [kk1 ]  *    B[i,l]; 

for  1:=1  to  size  do 

e?SI[i, j] :=PSI[i,d]  +A1A[i,l]  *  PSl[l,kkl]; 
end; 
end; 
end; 

for  i:=1  to  size  do 
begin 

Numcoef f [ i ] : =  0 . 0 ; 
for  d:  =  1  "to  size  do 

e§umcoeff [i] :=Numcoeff [i]  +  PSI[j,i]  *  C[1,j]; 

end; 
end; 

for  i:=1  to  size  do 
begin 

m:  =size  +  1 -i: 

if  numcoef f[m]  <>  0.0  then  goto  1; 
end: 

1 : sizezeros : =m-1 ; 
Clrscr ; Text Co lor (lightblue ) ; 

writeln('  ***  Bode   Plotting  Parameters  ***'); 
TextColor (yellow) ; 
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writeln(  ' ===================================== »  ); 

Msg('Open  (0)  or  Closed  (C)  Loop  Plot?' ,5,5); 
repeat 

input ( 'A' , ' ' ,45,5,2, true, F1 ,F10); 
{sets  flag  OpenLoop  if) 
temp  :=  copy ( answer .  1  ,  1  ) ; 

{user  selects  the  open) 
if  not (temp  in  ['O'.'C'J)  then  beep( 350 , 1 50  ) ; 

{loop  option  for  plot  } 
until  temp  in  CjO'.'C']: 
if  (temp  =  '0'  )   then  OpenLoop  :=  true 

else  OpenLoop  :=  false; 


{Wo  is  the'first  plotted  freq) 


Msg( ' Input  number  of  decades  do  you  want 

plotted?'  5, 10}; 
Input ( 'N' , ' ' ,51 , 10, 2, true, F1 ,F10); 
Val( answer ,NumberDecades , code ) ; 

root_f inder ( sizezeros , Numcoef f , realpartzero , 

imagpartzero , one ) ; 
root_f inder ( size , Dencoeff , realpartpole , 

imagpar tpole , one ) ; 

?ain:=  Numcoef f [sizezeros+1 ] ; 
or  i:=1  to  sizezeros+1  do 
begin 

Numcoef f[i] : =  Numcoef f[i] /gain; 
end; 
boxuser ; 

for  i:=1  to  maxorder  do  CDenCoeff[i]  :=  0.0; 
for  i:=1  to  SizeZeros  +  1  dor  _ 

CDenCoeff[i]  :=  Numcoef f[i]  *  gain; 

for  i:  =  1  to  Size  +  1  do        _  „  _  _ 

CDenCoeff[i]  :=  CDenCoeff[i]  +  Dencoeff[i]; 

if  Size  >  SizeZeros  then  CNPOLES: =Size 
{NPoles  should  always  be) 
else  CNPOLES: =SizeZeros; 
{greater, but  to  be  safecompute  new  denominator  roots) 

root  finder (Cnpoles , CDenCoef f .CRealPartPole , 
"~        CImagPartPole  ,  one  )  ; 

StartDecade  :=  trunc(Log( Wo ) ) ; 

{compute  linear  scale  to  plot  ) 
EndDecade  :=  StartDecade  +  NumberDecades ; 

{log  numbers.  Also  figure  step) 
Wf  : =  Wo  *  Expon( 10.0, NumberDecades ) ; 
DeltaW  :=  Expon( ( Wf /Wo ) , 0 . 01 25 ) ; 
Wi  :=  Wo; 

for  Count  :=  1  to  81  do{do  81  iterations ...  arbitrary ) 

Begin 

if  OpenLoop  then{ compute  bode  numbers  if  openloop) 

{and  later   if  closed  loop) 
begin 
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ZMagn : = 1 . 0 ;  ZPhase:=0.0;  PMagn:=1.0;  PPhase:=0.0; 

for  i  : =  1  to  SizeZeros  do 

{compute  magn  and  phase  of  zeros  for  freq  step) 
begin  _  _ 

ZMagn := ZMaen  *  Sqrt ( Sqr ( RealPartZero [I] )+ 

Sqr(Wi-ImasPartZero[l]T) ; 
if  RealPartZero[iJ  =  0.0  then 

ZPhase: =ZPhase+pi/2 . 0  else; 
begin 

if  realpartzero[i J  >  0.0  then 

ZPhase : =ZPhase  -  pi  +arctan((wi- 

imagp art zero [i J )/( -realpartzero [i J ) ) 

else 

ZPhase : =ZPhase  +  arctan((wi- 

imagp artzero[i J )/( -realpartzero [i] ) ) ; 
end; 
end; 

for  i  : =  1  to  Size  do 

{compute  magn  and  phase  of  poles  for  freq  step) 
begin  _  _ 

PMagn : = PMagn  *  Sqrt ( Sqr (RealPartPole [I] )  + 

Sqr (Wi-lmagPartPole[IJ ) ) ; 
if  RealPartPole [I]  =  0.0  then 

PPhase:=  PPhase+pi/2 . 0  else 
begin 

if  realpartpole[i ]  >  0.0  then 


P Phase : =PPhase  -  pi  +arctan( (wi- 

tpole[i] )/( -realpartpole[i J ) ) 


se  +  arctan((wi- 

tpole [i J )/( -realpartpole [i J ) ) ; 


imagp ar 
else 

PPhase : =PPhase 
imagp ar 
end; 
end; 

PlotArrayl [Count . 1 1  :=  Log(Wi); 
{fill  plotting  matrix  with  magnitude  values) 
PlotArrayl [Count ,2]  :=  20*LogfGain* % 

( ZMagn/ PMagn ) ) ; 

PlotArray2 [Count , 1 1 : =Los(Wi ) ; {f ill  phase  matrix) 
PlotArray2 [Count ,2]  :=  ( 180/pi ) *( ZPhase-PPhase ) ; 

{next  stmt  covers  freq  wrap-around) 
if  PlotArray2[Count ,2.  >  0  then 

PlotArray2 [count ,2] : =PlotAr ray2 [count , 2] -360 ; 

Wi  : =  Wi  *  DeltaW;  {increment  freq  step) 

end 

else 
{perform  same  steps  as  above  if  closed  loop  requested) 

begin 

ZMagn: =1 . 0 ; ZPhase : =0 . 0 ; PMagn := 1 . 0 ; PPhase : =0 . 0 ; 
for  i  : =  1  to  SizeZeros  do 

begin  _  _ „ 

ZMagn:=ZMa#n  *  Sqrt ( Sqr ( Real PartZero [I] )+ 

Sqr (Wi-ImaePartZero[l]T) ; 
if  RealPartZeroLI]  =  0.0  then 
ZPhase: =ZPhase+pi/2 . 0  else 
begin 

if  Realpartzero[i J  >  0.0  then 
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ZPhase : =ZPhase  -  pi  +arctan( ( wi- 

imagpartzero[i J )/( -realpartzero[i] ) ) 
else 

ZPhase : =ZPhase  +  arctan((wi- 

imagpartzero[i J )/ ( -realpartzero[i] ) ) ; 
end; 
end; 

for  i  : =  1  to  CNpoles  do 
begin 


Magn:=PMa2n  *  Sqrt ( Sqr ( CRealPartPole [I] )+ 

Sqr(Wi-CIma2PartPole[IJ )); 
if  CRealPartPole[I]  =  0.0  then 


PPhase : =PPhase+pi/2 .0   else 
begin 

if  crealpartpole [i J  >  0.0  then 

PPhase : =PPhase  -  pi_+  arctan((wi- 

imagp art pole [i] )/ ( -crealpartpole [i J ) ) 


c 

else 

PPhase: =PPhas 
cimagpar 


se  +arctan((wi- 

tpole[i J )/( -crealpartpole [i]  )  ) ; 


end; 
end; 


PlotArra.yl  [Count ,  1  ]  :=  Log(Wi); 
{fill  plotting  matrixwith  magnitude 
PlotArrayl [Count ,2]  :=  20*Los(Gain 


values) 


ZMagn/PMagn) ); 
PlotArray2 [Count , 1  J : =Log(Wi ); {fill  phase  matrix) 

PlotArray2 [Count ,2]  :=  ( 1 80/pi )*( ZPhase-PPhase ) ; 

{next  stmt  covers  freq  wrap-around) 
if  PlotArray2lCount ,2J  >  0  then 

Plot Array 2 [count ,2] : =PlotArray2 [count ,2] -360; 

Wi  :=  Wi  *  DeltaW; 
end; 
end; 

PlotBode( StartDecade .EndDecade .NumberDecades , 
PlotArrayl , PlotArray2 , OpenLoop ) ; 
end;  {bodeplot) 
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procedure  PlotBode( StartDecade ,EndDecade , 

Number Decades : Integer ; 
PlotArrayl .Plot Array 2 : PlotArray ; 
OpenLoop:  Boolean); 


const 

MagnAr  r  ay :  ar  r  ay [ 
char 


ill 


. . 12]    of 
'M'  ,  "»A'  ,  *G' 
E 


'N' 
'B' 


5; 


u 


D 


PhasArray:    array[l..12]    of 

char  =  (,P',''H,,,A,,,S',E,,,  ', 


integer 

char  ; 

integer 

real ; 
string 
string 
string 

i 
9 

9 
f 

3. 

.4. 
.3j 

• 

9 

• 
f 

• 

string[80] ; 
Boolean; 
real ; 
Boolean; 
text ; 

FreqArray:  string[1$]  ='' FREQUENCY  (rad/sec) 

var  i  ,j ,n 
ch 

x1  ,x2 
Delta 
MagLabel 
PhsLabel 
DecLabel 
Titlel  , 
Title2 
Dump Graph 
w 

quit 
list 

function  Log( X : real ): real ; 
Begin 

If  X=0  then  Log:=0  else 

Log  :=  Ln(X)/Ln( 10); 
End; 

function  Expon( Y , X : real ): real ; 

{computes  Y  raised  to  X  power) 
Begin 

Expon  :=  exp(  X  *  (ln(Y))); 
end; 

Procedure  PrintGraphData; 

{prints  numbers  to  a  file  or  printer) 
Begin 

LeaveGr aphic ; Clr scr ; 
repeat 
Textcolor (white);    gotoxy( 20 , 1 0  ) ; 

PROGRAM  OUTPUT  OPT I 


*  #  * 


OGRAM  OUTPUT 
P>  'printer  output 


writeln('   ** 

gotoxy(20, 13) 

writelnC • <P> 

Textcolor (yellow) ;     gotoxy(20. 

writeln( ' .    Check  Your  Printer! 


ONS  *** 
14); 


Textcolor (white ) . 
writelnC ' <F>  List 
gotoxy(20, 16); 
rriteln(  ' 


„otoxy(20, 15) ; 
to  File  name 


wr 


gotoxy 

writeln 
gotoxy ( 4 


on  the  current  drive 


17); 

<Q>  Quit 


'); 

); 

); 

'); 

'); 


goto 


,15) ;textcolor(yellow) ;write( ' "BODE 

3 , 1 7  )  J 

' f '  )  or  (ch  =  'P'  )  or 


.RES" » 


); 


gotox¥U«,in; 
readtkbd, ch) : 
If  (ch  =  'F? ) 
(ch  =  'p'  ) 


begin 

Tf  (ch  = 
begin 


or  (ch  = 

then 


'F'  )  or  (ch  =  ' f '  )  then 
NG 


gotoxy( 24 , 1 5 ) ; textcolor ( red) ; 
write( ' PRINTIN- 


'); 
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assign( list , ' Bode .RES' ) ; 

rewrite( list ) ; 
end 
else 
begin 

gotoxy! 24 , 1 3 ) ; text col or ( red) ; 

write! > PRINTING '); 

assign( list , '  LST : ' ) ; 
rewrite! list ) ; 
end; 

Title1:=('        w  (rad)  Gain  ( db ) 

,  Phase  ( deg) ' ) ; 
Title2:  =  (  ' — ----I '  )  ; 

writeln(list , »  BODE  PLOT  RESULT  '); 

writeln(list ):writeln( list ) ; 
writelnt list, Tit le1 1; 

writelnj list .Tit le2 )  ; 
writeln( list ) :  wr iteln( list ) ; 
for  i:=  1  to  81  do 
begin 

w  :=  expon( 1 0 . 0 , PlotArrayl [i , 1  J  ) ; 
writeln(list  '    ' >w: 1 1  :3 ,  y 

PlotArrayl Li, 2 J :8:3. ' 
PlotArray2[i,2J :7:3); 
if  i=  47  then 
begin 

write! list , chr ( 12)); 
writeln! list ) : 
writelnC list ,Title1 ); 
writeln(list.Title2): 
writeln! list ) ;  wr iteln( list ) ; 
end; 
end; 
end; 
until  ch  in  [ 'Q' , 'q* ] ; 
EnterGraphic ; 

(when  finished  printing,  go  back  to  graphics  mode 
and  display  graph) 


swapscreen: 
close! list ) ; 
end; 

Begin 

initgraphic;    (set-up  windows  for  display) 

DefineWindow! 1 , 0 , 0 , XMaxGlb , YMaxGlb ) : 

DefineWindow(2,5, 1 5 , XMaxGlb-5 , YMaxGlb-1 5 ) ; 

Def ineWindow  3 , 5 , 1 5 , XmaxGlb-5 , YMaxGlb-1 5 ) ; 

Def ineWorld! 1  ,0,0, 1 00, 1 00)  ; 

Def ineWorld! 2 ,StartDecade , 60 .EndDecade ,-60 ) ; 

Def ineWor ld( 3 , StartDecade , 0 .EndDecade , -360 ) ; 

SelectWorld! 1 ) : 

Select Window! 1 j : 

SetBackground(  0 ) ; 

SelectWorld! 2)  : 

SelectWindow( 2 ) ; 

DrawBorder  ; 

SetLineStyle! 1  ) ;  , 

For  I:=1  to  5  do  (draw  horizontal  graph  lines) 
DrawLine(StartDecade , -60+C20*I ) , 
EndDecade, -60+! 20* I) ) ; 
For  J:=0  to  NumberDecades-1  do 

{draw  vertical  logarithmic  graph  lines) 
Begin 
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For  I:-  1  to  10  do 

Begin 

Delta: ^StartDecade  +  (Log(I)  +  J); 
Drawl ine (Belt a, -60, Delta, 60) ; 

end; 
end; 

SelectWindow( 1 ) ;  {y-axis  titles) 

For  I:=  1  to  12  do 
Begin 

DrawText( 5 ,55+6*1, 1 ,MagnArray [II ); 

DrawText( 630 , 60+6*1 , 1 ,PhasArray [I J ) ; 
end; 

DrawText(250, 1 95 , 1 ,FreqArray) ;{x-axis  title) 
For 4 I : =  0  to  6  do       {y-axis  scale  label) 

6§tr( 60-20*1: 3, MagLabel); 
DrawTextT 12. 13+28*1, 1 .  MagLabel); 
Str  (  0-60* 1 :  4- ,  PhsLabel ) ; 
DrawText(600, 1 3+28*1 , 1 , PhsLabel ) ; 
end; 
For  I:=  0  to  NumberDecades  do 

{label  the  logarithmic  scale) 
Begin 

Str ( Truncf Star tDecade )+I : 3 ,DecLabel ) ; 
DrawText(36+(570  div  NumberDecades)  *I, 

186, 1 .DecLabel); 
DrawText(30+(570  div  NumberDecades)  *I, 
190,1  ,'  10'  ); 
end:         t     v 
SetLineStyle(0) ; 

SelectWindow(2) :  SelectWorld( 2 ) : 
DrawPolygon( PlotArray 1  , 1  , -81  .0,1  . 0 ) ; 

(plot  the  magnitude) 
SelectWorld(3)  ;[ 
SelectWindowi 3 ) ; 
SetLineStyleC 3 ) ; 
DrawPolygonC PlotArray2 , 1  ,-81  ,0,1  ,0) ; 

{plot  the ,phase) 
copyscreenj  {save  screen  to  memory) 

repeat  until  keypressed; 
quit  :=  false; 

repeat      {call  for  graph  options  menu) 
if  OpenLoop  then 

Graph_Menu( ' Open  Loop  Bode  Plot ' ,DumpGraph, quit ) 

else 

Graph  Menu( ' Closed  Loop  Bode ' ,DumpGraph , quit ) ; 
If  DumpGFaph  then  PrintGraphData; 

{dump  numbers  if  desired) 
until  quit: 

LeaveGraphic ;     {leave  graphics  mode) 
end; 
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{*  This  program  draw  line  for  menu  box.  *} 

procedure  box; 

var  i   : integer ; 

begin 

Highvideo: Text Color (yellow) ;gotoxy( 1,2); 

write( chr ( 21 8)  ) ;  (draw  upper  left  corner) 

for  i  :=  1  to  77  do    (draw  upper  horizontal  line) 

begin 

write( chr ( 1 96 ) ) ; 
end;  write(chr ( 1 91 ) ) ; 
gotoxy(1,5);   write( chr ( 1 92 ) )  ; 
for  i:=  2  to  78  do 

write( chr ( 196)); 
write(chr(217) ) ; 
for  i:=  3  to  4  do 
begin 

gotoxy( 1 , i ) ;write( chr ( 1 79 ) ) ;   {draw  vertical  lines) 

gotoxy(79, i ) ;write(chr( 1 79 ) ) ; 

got6xy( 1 ,23); 

for  i  :=  1  to  78  do 

wr ite( chr ( 1 96  )  ) ; 
wr  iteln('  ')* 

Text Color( white) ;gotoXY( 20 , 22 ) : 
writeln( 'Make  your  selection   }); 

§otoxy(40,22);Lowvideo;  {make  input  promt) 
; 
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Procedure  Fi_and_gamma( var  Trreal; 

var  fi:ary1s; 
var  gamma: ary 1s  ); 
label  1 ; 
var 

A2tA3,A4,A5  :ary1s; 

i , J ,k  : integer ; 

test_value , step  :real; 

begin 

test  value : =1 . 0e-08; 

step  :  =  1  .  0  ; 

for  i:=1  to  size  do 

begin 

for  j:  =  1  to  size  do 
begin 

I  .  i  ,  .i  J  :  =  0  .  0  ; 
hi,Ij :=1 .0: _ 

=  AlAri.il ; 


FI 
A4 
A2 
A5 
end* 
end; 
1  :for  i 
begin 
for  J 
begin 

A3I 

FI 

A2 


i,1     :=    AlAri,.11  ; 


=1    to    size    do 
=1    to    size    do 


_ij_  :=Flti,.iJ    +   A3L1.J1 
A^[i. j     :=A2[i,al    +    £    T    /    ( 

A5[I,JJ :=A5[I,J]    + 


to    size    do 


end; 
end; 

for    i:=1 
begin 

for  j:  =  1  to  size  do 
begin 

A4[i, j] :=0.0; 
for  k:=1  to  size  do 
j  A4[i ,j] :=A4[i , j J  + 
end; 
end; 

step : =step+1 . 0 ; 
for  i:=1  to  size  do 
for  1:=1  to  size  do 
if  abs(A3[i,dJ)  > 
oto  T  ; 


]; 

(step+1 .0)  * 
/  (step+1 .0))  *  A3[i,j]; 


A1A[i,k]  *  A3[k,j]; 


then  go- 
size 


for  i:=1  to  size  do 
for  i : =1  to,  ni  do 
GAMMA [i, j] :=0.0; 


(test_value  *  abs  (FI[i,j])) 
(initialize) 

{calculate  GAMMA  matrix  } 


for  i:=1  to  size  do 
for  j : =1  to  ni  do 

for  k  *  =  1  to  size  do 

GAMMA [i,j]  :=GAMMA[i,j]  +  A5[i,k]  *  B[k,j]; 
end; 
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Procedure  Matr ix_r eduction (Var  dumy_square : Ary1 ; 

Var  n ,m, rank : Integer ) ; 

Label  142;Label  145;Label  235;Label  170:Label  180; 
Label  162;  Label  198;Label  200;Label  224;Label  226; 
Label  228;Label  234; 

VAR 

reduction  matrix  :  Ary1 ; 

Jjc.Nmin,  i.j  ,ii  ,k.1  ,k,.1  1  ,  start , 

1 ,  11  ,  lmin,  li ,  Hi  ,  jk,  If  :  Integer; 

compare_value , temp _value , sum         :  Real; 

Begin 

For  i  : =  1  to  n  do 
For  .i:  =  1  to  m  do 

reduction_matr ix[i , j J  :=  dumy_square [i , 3  J ; 

compare  value  :=  1.00E-8; 

Jd  ?  :  =  1  ; 

Nmm  :  =  n  -  1  ; 

If  nmin  =  0  then  goto  235; 
For  i  : =  1  to  nmin  do 
Begin 

For  3  :=  33c  to  m  do 
Begin 
Ji  :  =  1  * 

For  k  : =  i  to  n  do 
Begin 
K  ~i  j  =  k  * 

If   abs(  reduction  matrix[k,3"])  >=compare  value 
then  G0T0  142;~  — 

End; 
End; 

G0T0  235; 

142: If  kj  =  i  then  G0T0  145; 
For  3"  1  :  =  j  3  to  m  do 

Be&in  p     -1 

Temp  value  :=  reduction_matr ix[i , 3 1  J : 
reduc"tion_matr  ix[i  ,  J  1  J  :  =reduction_matrix[kj  ,  3*  1  J  ; 

reduction  matrix[kJ  ,  3"  1  ]  :=temp  value; 
End;        ~  ~  _ 

1 45 : temp_value  :=  reduction_matrixLi , 3 3  J ; 
For  ik  :=  33  to  m  do    _  _     _ 

reduction  matr ix[i , 3k]  :=  reduction_matr ixLi , jkj 

/temp_value ; 

If  i  <>1  then  G0T0  180; 
s  t  ar  t  :  =  2  * 

162: for  1  :=  start  to  n  do 
Begin  _     _ 

Temp  value  :=  reduction  matr  ixl  1 ,  3  3"  J  ; 
If   abs(  reduction  matr ixLl , 3 3  J )  <=  compare  value 

then  G0T0  170;~  — 

For  11  :=jj  to  m  dp     _  _     _ 

reduction  matr ix[l , 11 J : =reduction_matrixLl » 11 J  - 
~"temp_value  *  reduction_matrix[i ,  11 J  ; 

170:End; 

G0T0  200; 

1 80 : imin  : =i-1 ; 

For  li  :=1  to  imin  do 

Begin  _      _ 

Temp  value  :=  reduction  matr ixLli , 3 3  J ; 

If   abs(  reduction  matr ix[li , 3 3  J )  <=compare  value 
then  G0T0  198;— 
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For  Hi  :=  ji  toil  do 

reduction_matr  ixfli  ,  Hi  J  :=  ■ 

reduction_matr ix[li ,111] -reduction_matr ix[i , Hi  J 

*temp_value ; 

198  :End;  start  :=  i  +  1; 

GoTo  162; 

200:  If  .-).-]  =  m  then  goto  235; 
„  Jjc  :=  jj  +1 ; 
End; 
For  jk  :=  j  j  to  m  do 

Be&in  p     -i 

Temp_value  :=  reduction_matrix[n , jkj ; 

J"ic  *=  ~i  k  * 

If   abs(  reduction  matr ix[n , ik] )  <=  compare  value 

then  GoTo  226;  ~  - 

For  i1  :=  jk  to  m  do 

reduction_matr  ix|_n , j 1  J  : =reduction_matr ix[n , j 1 ] / 

temp_value ; 

GoTo  228; 
226:End; 
GoTo  235; 
228: For  lf:=  1  to  nmin  do 

Be&in  r        -i 

Temp  value  :=  reduction  matr ix[lf . j J c] ; 

If   abs(  reduction  matr ix[lf , i i c] )  <=  compare  value 

then  GoTo  234 ;~  ~ 

For  i1  :=jjc  to  m  do,    . 

reduction_matrix[lf ,j 1  J  :=reduction  matrix[lf , j 1  J 

-temp_value  *    _  _ 

reduction_matrix[n, j j c] ; 

234:End; 

235: Rank  :=0; 

For  i  :=  1  to  n  do 

Begin 

Sum  : =  0.0; 

For  i  :=1  to  m  do 

Begin 

If   abs(  reduction_matrix[i  ,  1  ]  )  <■■=  compare_value 

then  reduction  matr  ix[i .  .j  J  :=  0.0; 
dumy_square  [i  ,  j  ]  :=  reduction_matr  ix[i  .  .1  ]  ; 
Sum  :=  sum  +  abs  (reduction  matr ix[i , j J ) ; 
End; 

If  sum  >=  compare  value  then   rank  :=   rank  +1 ; 
End;  - 

End; 

Procedure  matrix_multiplication( VAR  matrix. matrixl , 

matr ix2 : Ary1 s ; 
VAR  L,M,N  : Integer) ; 

var  mult  matrixl , result  matrix,mult_matrix2  :  Aryls; 

k, j ,i  :  Integer ; 

Begin 

For  j : =1  to  m  do 
begin 

For  i  :=1  to  1  do 
begin 

mult_matr ix1 [i , j ]  :=  matr ix[i , j ] ; 
end; 
For  k:=1  to  n  do 

mult_matr ix2 [j ,k]  :=  matr ix1 [ j ,k] ; 
End; 
For  i  :=1  to  1  do 
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Begin 

For  j : =1  to  n  do 
Begin 

result_matrix[i,j]  :=  0.0; 
For  k:=  1  to  m  do 

result_matrix[i , j J  : =  result  matrix[i,i]  + 
mult  matrix' [i,kj  *  mult  matrix2 [k, j J ; 
End;       —  "" 

End; 

For  i : =  1  to  1  do 
Begin 

For  i  : =1  to  n  do  _ 

matrix2[i,j]  :=  result  matrix[i,j]; 
End;  — 

End; 
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procedure  Inverse  find  matrix(VAR  A:Ary1s; 

—     ~        var  XD0T:ary4; 

var  ORDER : integer ; 

var  AINV:ary1s; 

var  X  :  ary4- ; 

var  singular : integer  )  ; 

label    5;label    6;label    12; label    16; label    20;label    51; 

var 

B2  :ary1s; 

comp ? temp or ary_value  :real; 

n,i,j,k,m  : integer ; 

begin 
n  :  =  1  j 

for  i:=1  to  order  do 
begin 

for  j:  =  1  to  order  do 

begin 


AINV[i,3]:=.0.0; 
B2[i,j] :=A[i,3 J ; 


end; 
end; 

for  i:=  1  to  order  do 
begin 

XlNY[i,il :=1 : 

X[i] :=XDOT[i] ; 
end; 

for  i:=1  to  order  do 
begin 

comp : =0 . 0 ; 

k  *  =  i  * 

6:if'(abs  (B2[k,i])  -abs(comp))  <=  0.0  then  goto  5; 

comp : =B2[k, i] ; 

n :  =k; 

5 :k: =k+1 ; 

if  (k-order)  <=  0  then  goto  6; 

if  B2[n.iJ  =  0.0  then  goto  51; 

if  (n-i)  <  0  then  goto  51; 

if  (n-i)  =  0  then  goto  12; 

for  m:=1  to  order  do 

begin 

temporary  value :=  B2[i,mJ; 

B2[i,mT  :=B2[n,m]; 

B2[n,m]  :=temporary  value; 

temporary  value :=  AlNV[i,mJ; 

AINVLi,mJT=  AINV[n,mJ; 

AINV[n,m]:=  temporary_value ; 
end;  _ 

temporary, value : =X[i J  ; 
XLiJ  :=X[n] ; 

x  n] : =tempgrary  value:, 
l£:i£i]:«XliI  /-B2ti,i]i 
temporary  value : =B2 [l , l]  ; 
for  m:=1  to  order  do 
begin 

AlNV[i .m] : =  AINY[i ,m]  /  temporary  value; 

B2[i  ,m]  :  =B2  [i  ,m]  /  temporary_value"; 
end; 

for  j:=1  to  order  do 
begin 


to  order 
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INV[j,n]:=  AINVH  ,n]  -  temporary  vali 
AINYfi  nl * 
B2[j ,n] :=B2[j ,n]  -'temporary  value  *  B2[i,n]; 
end;  — 

1 6 : end; 
end; 

goto  20; 
51  : singular :  =  1  ; 
20 : end; 
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Procedure  linear_equation(  var  AA:ar.y2; 

var  nw,m: integer ; 
var  BBfx:ary3; 
var  K : integer ; 
var  U: ary2 ) ; 

label    1; label    2:label    3;label    4:label    5;label    71; 
label    81; label    120;label    8;label    6    ; label    10; label    130; 
label    7; 

Var 

is , it ,kk,n ,k1 , ii ,mm, i , j  : integer ; 

a1  :ary2; 

id  :ary3; 

b1  ,  d  , ic ,w  : real ; 

Begin  {linear  equation) 
n: =nw; 
mm: =m+1 ; 

for  i:=1  to  n  do 
Begin 

Al[i,mm]  :=  BB[i]; 
for  i : =  1  to  m  do 

A1 fi.dJ  '=    AA[i,j]; 

End; 

k  :  =  1  ; 

if  (n-m)  >=  0  then  goto  1 ; 

it : =  n+1 ; 

n:  =m; 

for  i:=  it  to  m  do 

Begin 

for  i:=1_to  mm  do 


1 :  =  1 _ t  o  mm  do 
A1  [i,j]  :=  0.0; 

End; 

ID[i 


1 ' f PC  i ' =1  to  m  do 
i]  :=  i; 


2 :kk: =k+1 ; 

is : =k; 

it • =k • 

B1 :=abs(A1 [k,k] ); 

for  i : =k  to  n  do 

Begin 

for  j : =k  to  m  do 

Begin 

if(  abs(A1 [i , j] )-B1 )  <=  0  then  goto  3; 
is : =i ; 

m    |l:=abs(A1 [i,j]); 

3: End; 
End; 

if(is-k)  <=  0  then  goto  4; 
for  J : =  k  to  mm  do 
Begin 

d  1=  A1 lis ,j  J  :  _ 
^  A1 C±S,dJ  :=  Ai[k,j]; 
A1  Lk, j J :=  d  ; 

4:if(it-k)  <=0  then  goto  5; 
ic  :  =ID[I 


Elicit]  j 


IDfk, 

ID[it]  :=ic; 

for  i : =  1  to  n  do 

Begin 

CI  :=A1 li.itl ; _ 

A1 [i,  it]  :=  A1 [i ,k] ; 
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A1 [i,k]  :=c1 ; 
End; 

5:if   A1 [k,k]  <>  0  then  goto  71; 
kk: =k; 
k:=k-1  ; 
for  i : =kk  to  m  do 

A1  [j  ,j]  :=  -1  .0; 

goto  6: 

71:if  (k-n)  >0  then  goto  120; 
if(k-n)  <  0  then  eoto  81; 
A1[n,mm]  : =A1 [n ,mm]  /  A1[n,nJ; 

§oto  7; 
1:for  3 : =kk  to  mm  do 
Begin 

S1[k,J]  :=  A1 [k,i]  /  A1 [k,k]; 

for  l : =  kk  to  n  do 

Begin 

w:=A1 [},k]  J  A1 [k,j]; 
* =A1 [l -i J  -w; 

)    -  0.0001 *abs(w) )  >=  0 


A1  [i,5 J ,  :=A1 [i. 

ifL(aDs(Alfi,i] 
„then  goto  8; 

Q  A1[i,dJ  :=0.0; 

8: End; 
End: 

if  (k-m)  >0  then  goto  120; 
if  (k-m)  =  0  then  goto  6; 
k: =kk; 
goto  2 \ 
6:for  i;=kk  to  n  do 

if  Al[i,mmJ  <>  0  then  goto  120; 

7:k1 :=k-1 ; 

for  is:=1  to  k1  do 

Begin 

i : =k-is ; 

ii : =i  +1 j 

for  it:=ii  to  k  do 

Begin 

for  1 : =kk  to  mm  do, 

A1[i,dJ  :=A1[i,j]  -Al[i,it]  *Al[it,j]; 

End; 
End; 

for  i : = 1  to  m  do 
Begin 

for  d : =1  to  m  do 
Begin    „  _ 

if  (ID[l]-i)  <>  0  then  goto  10; 
xrij  :=A1[d,mml; 
if  (k-m)  =  0  then  goto  10; 
for  is:=kk  to  m  do 

U[i,is-k]  :=  A1[j,isJ; 

1 0:End; 
End; 
k : =m-k ; 
goto  1 30 ; 
1 20 :Writeln; 

Writeln( ' There  are  no  equations ' ) ; Delay( 2000 ) ; 
130:End;  (linear  equation) 
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Procedure  Polynomial_of_roots( var  n: integer: 

var  rr,ri:ary3s; 
var  cf :ary4 ) ; 

(This  program  calculates  the  coefficients  of  a 
polynomial  from  its  roots) 

label  1; label  3; label  111;label  222; label  2; 
label  5;label  21;label  50; 

var 

ick , nn ,  mp , i , ii . 1 ,m,mm,mmp  : integer ; 

sumreal ,prreal1 , sumimag,prreal ,primag  :real; 

3  :ary6; 

Begin 

nn:=n+1 ; 
CF[nn] :=1 .  0; 
for  m:=1  to  n  do 
Begin 

sumreal : =0 . 0 ; 

sumimag: =0.0; 

1  •  =  1  • 

Jti1:=i; 

f?j?ii;=jri]+i : 

2:if  (1-m)  >0  then  goto  50; 
if  (1-m)  =  0  then  goto  5; 
mm: =m-1 : 

for  i:=l  to  mm  do 
Begin 

„  J[ii]:=Jti]+1 ; 

End; 

5 :prreal : =1 . 0 ; 

prreal 1 : =1 . 0 ; 

pr imag: =  0.0; 

for  i : =1  to  m  do 

Begin 

prreal i=prreal1 ; 

ick: =J[i] ;  _  _ 

prrealT:=  prreal*RR[ickJ  -  primag*RI [ick] ; 

primag: =   prreal *RI [ickj+pr imag*RR[ick] ; 
End; 

sumreal  :=  sumreal+prreal 1 ; 
sumimag :=   sumimag+primag; 
for  i :  =  1  to  m  do 
Begin 

if"" 
if 

End; 

mp : =n-m+1 ; 

mmp : =mp  mod  2 ; 

if  mmp  <>  0  then  goto  111; 

CF[mp]:=  sumreal ;goto  222; 

1 1 T :  CF[mp] : =-sumreal ; 
222:End; 
goto  21 ; 
50:Writeln; 
Writeln( ' There  is  an  error  in  polynomial 

calculation  from  roots  procedure'); 
Delay(2000); 
21 :mmp : =  n  mod  2 ; 
if  mmp  <>  0  then  goto  3; 
for  i : =  n  downto  1  do 

CF[i] :=-CF[i] ; 

3: End; 
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Plot  Nyquist  is  a  routine  to  draw  the  Nyquist  plot 
rom  the  data  generated  in  the  Nyquist  procedure.  > 


I 

Procedure  Plot_Nyquist ( StartDecade ,  EndDecade , 

Number Decades : Integer ; 
FreqArray , PlotArrayl , 
Plot array 2 , 

MagPhaseAr r ay : PlotAr ray : 
BigPic , OpenLoop : Boolean ) ; 


integer ; 
real;  _  _ 
String[3lj 
String[80] ; 
Boolean; 
Real ; 


var 

Xint,Yint,  i,."),n,  code 
Ymin,Ymax,  Xmin,xmax 
XLabel ,YLabel 
Titlel ,Title2 
DumpGraph , quit 
w , XminL , YminL 

GraphWidthX,GraphWidthY:  Real; 
Xexponent , Yexponent    :  integer; 
XexpLabel , YexpLabel    :  string[3] ; 
GraphArray  :  PlotAr ray; 

List  :  text; 


function  Expon( Y , X : real ): real ; 

{computes  Y  raised  to  X  power) 
Begin 

Expon  :=  exp(  X  *  (ln(Y))); 
end; 

Procedure  Pr intGraphData; 

{dump  data  used  to  make  graph  to  printer) 
Begin 

LeaveGraphic ; Clr scr ; 
repeat 
Textcolor( white );     gotoxy(20 . 1 0 ) ; 
writelnf'   ***  PROGRAM  OUTPUT  OPTIONS  ***  *  ): 

fotoxy(20 . 1 3 ) ;wr iteln( ' < P>  Printer  output     '); 
extcolor (yellow) ;     gotoxy ( 20 , 1 4 ) ; 
writeln( '     Check  Your  Printer!  '); 

Textcolor (white) ;     gotoxyC 20 , 1 5 ) ; 
writeln('<F>  List  to  File  name  '); 

gotoxy(20, 16); 

writeln( '     on  the  current  drive  '); 

gotoxy(20,17):  . 

writeln('<Q>  Quit  '); 

gotoxy(42 . 1 5 ) ; 

textcolor (yellow) ;write( ' "NYQUIST .RES" ' ); 
gotoxy(28,i7); 
read! kbd.ch) : 
If  (ch  =  'FM  or  (ch  =  »f»)  or  ( ch  =  'P')  or 

( ch  =  'p ' )  then 
begin 

if  (ch  =  'F')  or  ( ch  =  'f')  then 
begin 

gotoxy( 24 ,1 5) ; textcolor ( red) ; 

write(  !  PRINTING '); 

as sign (list. 'Nyquist .RES ' ) ; 
rewrite! list ) ; 
end 
else 
begin 

got oxy( 24 ,1 3) ; textcolor ( red) ; 

write!  '  PRINTING '  )  ; 

assign( list, 'LST: ' ) ; 
rewrite! list ) ; 
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end: 
Tltlel 


=  (  ' 

Phase 


w  (rad) 

(rad) 


Magnitude 
Xplot 


Title2:= 

wr iteln( 

write!] 

writel 

wr itel 

for  i  : 

begin 

w  :  = 

writ 


YPlot ' ); 
) 


st,'  NYQUIST  PLOT  RESULT  f); 

list ):writeln( list ):  , 
list.Titlel):  writeln( list , Tit le2 ) ; 
list):  wr iteln( list ) ; 
1  to  81  do 


FreqArray[i , 1 ] : 
eln( list ,w:9:3, * 

MagPhaseArray 
MagPhaseArray 


if  i 
begi 
wr 
wr 
wr 
wr 
wr 
end; 
end; 
end; 
until  en  in 
EnterGraphic 
swapscreen; 

close( list 
end; 


PlotArrayl Li , 1 . 
PlotArrayl [i ,2 
then 


0 


1  1 
1  1 
3 

3 


0  :3  > ; 


ih 


=  47 

n 

iteln( list ) , 

iteflist ,chr( 12) 

itelni list, Title 

iteln(list.Title2y 

iteln(list);  writeln( list ) ; 


C'Q' , 'q']; 

9 

); 


Begin  {Plot 

if  not(BigP'ic 
begin 


ist)  {prompt 
then 


for  window  parameters) 


3. 

4. 
5 

6 


_  > 


151 1N00503-01 0101 
1512N00504-010101 
1513N00505-01 0101 
1514N00506-010101 


Clrscr;  TextColor  (Li, 
writeln(  '  ***  NYQUIi 
textcolor (yellow) ; 

writeln(  '=  =  =  =  =  = 


;htBlue); 
JT  PLOTTING 


PARAMETERS  *  *  *  »  ) 


) 


the 


HighVideo; 

writeln;writeln: Textcolor  (white ) ; 

msg( ' Input  Plotting  Coordinates  for 

Nyquist  Plot'71,6); 
TextColor (yellow) ; 
writeln:writeln;writeln;writeln;  writeln; 
writelm  'X-Minimum: 
wr  itelni  'X-Maximum: 
writelnt  'Y-Minimum: 
writelnl 'Y-Maximum: 


Input  Handler ( 'N0306 ' .Escape) 
writeln: writeln; 
writeln('Any  changes  to  these 

(Y  /  N) :  '  )  : 
Input (  'A'  ,  »  '  ,45,  16, 2,  t 
If  (answer='Y')  or  (F1 
Input  Handler('C03 
Val ( f i IvarL3 J , Xmin , code ) 
Val(fil 


parameters? 


Lnd 

9: 


ue,F1 ,F10) 

then 
§ ' .Escape ) 


var [4] , Xmax , code ) 
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ValC  f ilvar [5] , Ymin.code ) ; 

Val(f  ilvar  [6]  Jmax.code  ) ; 
end 
else 
begin 

Xmax : =  100; 

{set  default  values  for  "big  picture"  plot) 

Xmin:=  -100; 

Ymax:=  100; 

Ymin:=  -100; 
end; 

INITGRAPHIC; 

niceaxes(xmin,xmax,ymin,ymax,  ''); 
n  :  —  1  * 

for  i:=1  to  80  do  _ 
if(abs(plotarrayl[i,ll)  >  Xmax)  or 

( abs( plotarrayl [l . 2] )    >  Ymax)  then    n:=  n+1 ; 
if  n<>1  then  n:=  n-1 ; 

{use  1  extra  point  beyond  graph  border) 

DrawPolygon( PlotArrayl  ,n, -80 ,0,1  , 0 ) ; 

{draw  graph  on  screen) 
n  :  =  1  * 

for  i:=1  to  80  do  _ 
if  (abs(plotarray2 [i ,  1  J )  >  Xmax)  or 

(abs(plotarray1[i,2J)  >  Ymax)  then 

n: =  n+1 ; 

if  n<>1  then  n:=  n-1; 

Setlinestyle  (1); 

DrawPolygon(Plotarray2,n,-80 ,0,1 ,9) ; 

Repeat  until  Keypressed; 

{Put  option  menu  on  screen) 
quit:=  false; 
repeat 
if  OpenLoop  then 

Graph_Menu( ' Open  Loop  NyquistPlot ' , 
DumpGr  aph , qui  t ) 
else 
Graph_Menu( ' Closed  Loop  Nyquist  Plot', 

DumpGr  aph , quit ) ; 
if  DumpGraph  then  Pr intGraphData; 
until  quit j 
LeaveGraphic ; 
end; 
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{Graph_Menu  provides  a  window  on  screen  and  offers  the 
user  options  to  make  a  title,  print  the  graph,  print 
the  numbers  from  the  graph,  or  quit  and  return  to  the 
menu.   } 


Procedure 


var 

Linel 


Gr  aph_Menu ( T  i  1 1 eWindowName : STR25 ; 
var  DumpGraphData, quit 

Line2,  Line3   :  string[40] ; 


boolean ) ; 


Procedure  TitlePrompt; 
begin 

Text Color( White ) ; 

Center('***  Graph  Title  *** * , 1 ,2, 80 ) ; 


[1 1  :=  '101 
[2] :=  '101 
[3] :=  '101 


0A04001 -01 01 00' 
2A04002-01 01 00' 
4A04003-010100' 


text co lor (yellow) 


msgi 
msgi 
msgi 


'  Line 
'Line 
'Line 


1 


text co lor (green); 
msg('Type  your  title 

Input_handler( 'N0103 


for  your 
, escape ) 


graph. ' ,6,20) 


Linel : = 
Line2 : = 
Line3 : = 


copy 
copy 
copy 


f ilvar 


filvar [2! 
f ilvar 


1 


end; 


Procedure  ShowTitle; 

(makes  title  block  and  writes  title  to  block) 


begin 

copyscreen: 
SetLine Style 
Def ine Window 
Def ineWorld( 
SelectWorld(3 
Def ineHeader  ( 


20,40.60) 


.0,0;40;16);   ' 
);  SelectWindow( 
3 , TitleWindowNan 


3 

ame 


)! 


(puts  header  on  box) 


SetBackground( 0 ) ; 

SetHeader On ; Dr awBor  de 


DrawTextW 
DrawTextW 
DrawTextW 
SetBreakO 


1,4,1 , Linel 
1 ,8,1 ,Line2 
1  ,12,1  ,Line: 


I     ,     I   £.    ,     I     ,  D1X1C  J   )    i 

'f;  SetMessageOff ; 


:h)  o 


repeat 

read(kbd,c 
case  ord(c 
(allow  user 
72  :  MoveVer(-4 
75 
77 
80 
end; 
until  ord(ch)=  13; 

(freeze  box 
end; 

begin 


to  move  titli 
( -4, true ) ; 
MoveHor ( -1 . true ) ; 
MoveHor ( 1 , true ) ; 
MoveVer ( 4 , true ) ; 


box  anywhere 
up  arrow) 
left  arrow) 
right  arrow) 
down  arrow) 


on  screen) 


and  continue  with  <return>  key) 
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DumpGraphData: =  False; 
selectscreenM ); 
copyscreen;  SexLineStyle( 0 ) ; 

{save  underlying  screen  and  display  menu  box) 
DefineWindow(4,1 1 ,20,35,90) ; 
DefineWorld(4.0,0,20,20 )  ; 
SelectWorld(4) ;  SelectWindow( 4 ) ; 
Def ineHeader ( 4 ,  'Graph  Options  Menu'); 
SetHeaderOn;  SetBackground( 0 ) ;DrawBorder ; 
DrawTextW( 1 ,4 , 1 . ' <P>   Print  Graph  to  the  printer'); 

(display  menu  options) 
DrawTextW  1 ,7, 1  ' <T>   Make  Title  to  the  Graph'); 
DrawTextW( 1 , 1 0 , 1 , ' <N>  Print  Table  of  Numbers'): 
DrawTextW  1 , 1 3, 1 , '      used  to  Generate  Graph' }; 
DrawTextW( 1 , 1 7, 1 , ' <Q>  Continue  to  the  Program'); 
repeat 
Option; 

case  ch  of     (interpret  user  input) 
' P ' :  begin 

swapscreen: 

(redisplays  screen  without  menu  box) 
hardcopy( false , 1 ) ;   (print  to  printer) 
copyscreen; 
ch  :  =  'P'; 
end; 
' T ' :  begin 

leavegraphic ;    (leave  graphics  screen) 
TitlePrompt;     (prompt  for  title) 
entergraphic;    (return  to  graphics  mode) 
swapscreen:      (bring  back  graph) 
ShowTitle ; (display  title  box  on  screen) 
copyscreen; { save  graph  with  title  box) 
ch  : =  ' T ' ; 
endj 
• N ' :  begin 

DumpGraphData  :=  True; 

(sets  boolean  to  cause  numbers  ) 
(to  be  printed) 
ch  :=  'N'; 


end; 


end; 


until  ch  in  [ ' P ' , ' T '  ' N ' , ' Q ' ] ; 
if  ch  =  'Q'  then  Quit  :=  true 
else  Quit  :=  false 
end; 
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procedure  input_Factored(Zeros_or  poles :str5; 

NFactors : integer ;var  real_part, 
imaginary_par t : ary3s ) ; 

{Begin  processing  Factored  form  Input-Internal  routine) 


var 
test 
begin 


integer ; 
real ; 


P 

.1 1 . 

p 

.12 

p 

.13. 

p 

.14-. 

p 

.15. 

p 

16 

p 

.17. 

p 

.18 

p 

.19. 

p 

.20. 

p 

[21  . 

p 

.22. 

p 

.23. 

p 

.24. 

p 

.25. 

p 

26 

p 

.27. 

p 

.28^ 

p 

.29. 

p 

.30. 

_   > 
_   > 


_   > 
_   > 


_   > 
_   > 


_   > 
_   » 


_   > 

_   » 


_   » 
_   » 


0905N01 
2505N01 
0907N01 
2507N01 
0909N01 
2509N01 
091 1N01 
251 1N01 
0913N01 
251 3N01 
0915N01 
2515N01 
0917N01 
2517N01 
091 9N01 
2519N01 
0921N01 
2521N01 
0923N01 
2523N01 


1  ■ 

2 

3- 

4' 
5- 
6- 
7- 


01 

01 

01 

01 

01 

01 

01 

018- 

01  9- 

020- 

021  - 

022- 

023- 

024- 

025- 

026- 

027- 

028- 

029- 

030- 


000 
000 
000 
000 
000 
000 
000 
000 
000 
000 
•000 
■000 
•000 
■000 

■  000 
•000 
•  000 

■  000 

■  000 
•000 


1  01 
1  01 
1  01 
101 
101 
1  01 
1  01 
101 
101 
1  01 
1  01 
1  01 
101 
101 
101 
1  01 
101 
101 
1  01 
101 


ClrScr;  TextColor( White ) ;    {write  screen  titles) 
gotoXYd  .24); 

Invvideo( ' Press  <ESC>  to  change  an  entry' )j 
Center('***  Desired  characteristic  Polynomial 

Input***' ,1,1 ,80); 
HighVideo;        , 
writeln ; Text Co lor (green ) : 
if  Zeros  or  Poles  =  'ZEROS'  then 

write"ln(  'NUMERATOR  Transfer  Function 
Input  —  FACTORED  Form' ) 
else 

writeln( ' Character istic  equation 

Input  —  FACTORED  Form'); 

HighVideo : writeln; writeln; 

for  41:  =  1  to  NFactors  do    {type  prompt  strings) 
begin 
writeln( '    s  =  +j ' ) ; 

writeln; 
end; 

str( (NFactors* 2+1 0) :2,strg) ; 

specification  :=  concat( 'N1 1 ' , strg) ; 

Input_handler( specif ication,  escape); 

{call  the  input  handler) 

for  J:=  1  to  NFactors  do 

\ compute  the  zero  values  from) 
begin       {input  handler  string  Filvar) 
val(filvar £2*1+9  J , test , codel ; 
if  code  =  0  then  Real  Part [j J : =test ; 

{val  conversion  successful  if  code) 
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val(filvar [2*3+1 0] , test , code ) ; 

{=0,  error  otherwise) 
if  code  =  0  then  Imaginary_Part [j J : =test ; 

,  end; 
end;  (procedure  Input_f actored) 

(Begin  processing  Coefficient  form  Input-Internal 
procedure   > 

Procedure  Input  Coeff(Zeros  or  Poles:Str5; 

"~       NCoeff : integer : 

var  Coeff:  ary4 ) ; 


var 


kx.3 


(counters  > 


NCoeff_old  :  integer;   (holds  old  poly  order  if 


test:  real; 


changing  order) 
(holds  "val"  results  until  validated) 


p 

.22. 

•  —     * 

P 

.23. 

:  = 

P 

,24. 

:  =     » 

P 

.25. 

: =     ' 

P 

.26 

: =     ' 

p 

.27. 

: =     ' 

p 

.28. 

: =     ' 

p 

.29. 

: =     ' 

p 

.30. 

:  =     ' 

begin 

P[21]   :=  '0406N01 021-000101 ' ; 

(Input-Handler  descriptors  for  coeff) 
1806N01 022-000101 • ;   (form  input) 
3206N01023-000101 " 
4606N01 024-000101 
0408N01025-000101 
1808N01 026-0001  01 
3208N01 027-000101 
4608N01 028-000101 
041 0N01 029-0001 01 
181 0N01030-0001 01 

NCoeff_old:=  NCoeff; 

ClrScr:  TextColor (White ) ;  (print  screen  titles) 

gotoxy( 1  , 24  )  ; 

invvideo( ' Press  <ESC>  to  change  an  entry'); 

gotoxyC 1,1); 

writeln( '  ***  Desired  characteristic 

Polynomial  input  ***'); 
TextColor ( Green) ; 
if  Zeros_or_Poles  =  'POLES'  then 

writeln( 'NUMERATOR  Transfer  Function 
Input  —  COEFFICIENT  Form') 
else 

Gglwrite( 'COEFFICIENT  Form  '); 

TextColor ( lightmagenta) ; 
if  not  luen  then 

writeln( ' Highest  degree  coefficient 
MUST  be  1.0'); 

end; 
HighVideo ; 


if  NCoeff  >  NCoeff_old  then 
begin 

or  .i:  =  1  to  NCoeff  old  -  NCoeff  do 
>r  i:=NCoeff  old  +  1  downto 
Filvar[i+1]  :=  Filvar[iJ; 


U\ 


do 


end; 
if  NCoeff  <  NCoeff  old  then 
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begin 
for  i:=  1  to  NCoeff  old  -  NCoeff  do 
for  i:=  1  to  NCoeff  old  +  1  do 
Filvar[i]  :=  Filvar[i+1J; 
end; 

VertPos  :  =  4  * 

for  i:=NCoeff+1  downto  1  do 
begin 

i:=NCoeff+1  -  i; 

PosCounter  :=  CI  mod  4)  +  1 ; 

HorizPos  :=  PosCounter  *  14: 

If  PosCounter  =  1  then  VertPos  :=  VertPos  +  2; 

if  i<>  1  then{prompts  for  coeff  input) 
begin 
msgt's  +'  , HorizPos .VertPos  ) ; 
str( i-1 : 2 .Exponent ); 

msg(Exponent ,HorizPos+1  ,VertPos-1  ); 
end; 
end; 

str( (20+NCoeff+1 ) :2 ,strg) ;  {sets  up  and  calls 

input  handler) 

specification  :=  concat( 'N21 ' , strg) ; 

Input_handler ( specification , escape ) ; 

for  i : =  NCoeff +1  downto  1  do 
begin 


end; 


val(Filvar [NCoeff +22-11 , test , code) ; 
if  code  =  0  then  Coef f [j J : =test ; 
end; 


152 


FILE:  POLYNOM. INC     Program  Listing  Page  1 

procedure  character istic_equation(var  A3:ary1s; 

var  N: integer; 
var  C2:ary4); 

{This  procedures  computes  the  characteristic  equation 
polynomials  coefficients  by  using  the  principle-minor 
method) 

label  10; label  20;label  30;label  40;label  50; 
label  60;label  15;  label  70;label  80;label  90; 
label  100; label  1; label  2; label  5; 

var 

B3,A1  :ary1s; 

integer  vector     „       _  :ary6; 

D10  ""      :    array    [1..280]    of   real; 

mm, ii , 1 ,m. i ,kk ,nr ,nc ,k1 . il i , 

counter ,mi m, even ,nn , k , j 1 ,n1 ,m1  : integer ; 

temp _value . det , det  correction, 

determinanx_old, determinant , value_c2 , value  : real ; 

begin 

nn : =  n+1 : 

for  i : = 1  to  nn  do 

begin  _ 

C2[i] :=0.0; 
end;  _ 

C2[nn] : =1 . 0 ; 
for  m:=1  to  n  do 
begin 

k : =0 •  1 :  =  1  • 

integer_vector [ 1 ] : = 1 ; 

goto  2; 

1  : integer  vector [1 J : =integer  vector[lj+1; 

2:if  (I-m)  >  0  then  goto  90;~ 

if  (1-m)  =  0  then  goto  5; 

mm: =m-1 ; 

for  i : =  1  to  mm  do 

begin 

ii : =i+1 ; 

integer_vector [ii J : =integer_vector [i]+1 ; 
end; 

5 : f or  i:=1  to  m  do 
begin 

for  kk:=1  to  m  do 
begin 

nr  :  =mteger_vector  [i J  : 
nci=integer    Yectorlkk] ; 
B3[i,kkJ :=A3[nr ,nc] ; 
end; 
end; 
k:=k+1 ; 

counter  :=  0; 

for  i1 i  :  =  1  to  M  do 

begin 

for  j 1 : = 1  to  M  do 

begin 

X1  [i1i,dl]:=  B3[i1i,d1]; 

end; 
end; 

for  i 1 i  :  =  1  to  M  do 
Begin 

30:if  Ai[k1,i1i]  <>  0.0  then  goto  10; 

k1  • =k1 +1  • 

if*(k1-M)  <=  0  then  goto  30; 

goto  40; 
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10:if  (i1i-k1)  >  0  then  goto  40; 
if  (i1l-k1)  =  0  then  goto  70; 
for  m1m:=1  to  M  do 
Begin 

tei 

A 

A' 
End; 

counter : =  counter+1 ; 
70: ii : =i1 i+1 ; 
if  ii  >  M   then  goto  20; 
for  m1m:=ii  to  M  do 
Begin 

if   A1[m1m»i1i]    =    0.0    then   goto   80; 

value : =A1 [m1m. i1 i J    /    A1[i1i,i1iJ; 

for  n1:=  i1i  to  M  do 

begin 

A1 [m1m,n1 J : =    A1[m1m,n1]    -   A1[i1i,n1]    *    value; 

end; 

80: End; 
20:End; 
det  :  =  1  .0; 

for  i1  i  :  =  1  to  M  do 
begin 

det := det  *  A1  [i  1  i , i 1 i]  ; 
end;  /  • 

det  corrections  exp(  counter  *  ln(1.0)); 
determinant  old:=det  correction  *  det; 
even:=  counter  mod  2T 
if  even  <>  0  then  goto  60; 
determinant  :=  determinant_old; 
goto  50; 

60 : determinant : =-determinant_old; 
goto  50; 
40 : determinant : =0 . 0 ; 


50 :D1 0 [k] : = determinant ; 
for  i : =    to  m  do 


begin 

1 : =m-i+1 ; 

if  ( integer_vector [l]-(n-m+l ) )  >  0  then  goto  90; 

if  (integer  vector [1] -(n-m+1 ) )  <  0  then  goto  1; 
end; 

ml : =n-m+1 ; 

value_c2:=exp(  m  *  ln(1.0)); 

even:=  m  mod  2; 

for  i:=1  to  k  do 

begin 

if  even  =  0  then 
begin 

value  c2:=value  c2 ; 
goto  15; 
end; 

if  even  <>  0  then 
begin 

value_c2 : =-1 . 0  *  value_c2; 

15:C2[m1 ] :=C2[m1 1  +  D1 0  Til  *    value_c2; 
value_c2 : =exp(  m  *  ln(1.0)); 
end; 

endjgoto  1  00 ; 

90 :writeln( ' Error  in  characteristic  equation'); 
1 00 :end; 
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{  This  procedure  uses  modified  BARSTOW  method  to 
calculate  the  roots  of  the  polynomial  } 

PROCEDURE  root_finder(var  n: integer; 

var  A:ary4; 
var  u,v:ary3s; 
var  ir: integer); 

{  label  decleration  for  the  GOTO  statement) 

label    3;label    4;label    7;label    9;label    10;label    13; 

label    15;label    19; label    20;    label    23;label    30; 

label    32;label    33;label    34;label    36:iabel    49; 

label    50; label    52; label    53;    label    70: label    72; label    73; 

label    75;label    76;label    81; label    82;label    100; 

var 

irev, i ,nc ,m,nl ,np , j , i1 : integer ; 

p , q , r , f , e , cbar , d, qp ,pp : real ; 

H,B,C:  array  [1..21]  of  real; 

Begin 

irev:=ir;  {take  given  values) 
nc : =  n+1 : 

for  i;=i  to  nc  do 
H[i]:=  All]; 

p:=0.0;   (initialization) 
q:  =0  .0; 
r  :  =  0  .  0  • 

3:if*H[l]  <>  0  then  goto  4; 
nc : =  nc-1 ; 
ULncT: =0.0; 
V[ncJ : =0 .0: 
for  i:=  1  to  nc  do 
H[i]  :=  H[i  +  1]; 

goto  3; 

4:if  (nc-1 )  =  0  then  goto  100; 

if  (nc-2)  <)►  0  then  goto  7; 

r  :=-HM  J/H[2]  ; 

goto  50; 

7 : if ^(nc-3 )  < >  0  then  goto  9; 

p:=H[2T7H[3] ; 

oto  lV'*' 
f?if  (abs(H[nc-l]/H[nc] )-abs(H[2] /H[1 ] ))  >=  0.0 

then  goto  1 9 ; 
irev: =-irev; 
m:  =nc  div  2 ; 
for  i : = 1  to  m  do 
begin 

nl : =nc+l -i ; 

F 

H 

H 
end: 

if  Q  <>  0.0  then  goto  13; 
p:  =0.0: 
goto  15: 
13:p:=p/q; 
q :=1 .0/q; 

15:if  r  =  0.0  then  goto  19; 
r :  =  1 . 0/r  ; 
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1 9 : e: =5 . 0e- 


ncj  : =H[nc. 
nc] : =H[nc 
nc+1 ] : =  0 . 0 
nc+1 J : =0 .0 
np : =nc-1 ; 
20: for  j : =  1 
begin 

for  i1  :  = 
begin 


0; 


to  1000 
1  to  np 


do 
do 


end 


Bfi??=H[il  +  R  *  B[i+1]; 
C[i] :=B[i]  +  R  *  C[i+1 J ; 


if  (abs(B[l ]/H[1 1 )-e)  <=  0.0  then  goto  50; 
if  C[2J_<>  0.0  then  goto  23; 


r : =r+1 . 0; 

foto  30; 
3:r  :=r  -  B[1]/C[2] ; 
30: for  11: *  1  to  np  do 
begin 

i i=nc-i1  : 

B[ij:=  HLil  -  p  *  B 

C[i]:=  B[i]  -  p  *  C 
end; _  _ 

if  H[2]  <>  0.0then  soto  32; 
if  Cabs(Br2J/H[l .  )-e)  >  0.0  then  goto  34; 


if  (ab 

32: if  (abs. 

33:if  (abs(B 

34:cbar:=  C 

d:=C[3J  *  C 

if  d  <>  0.0 

p:=p  -2.0; 

Q:=  q  *  (q  + 

goto  49;    ,  _  _ 

36:p:=  p  +  CBf2] 
Aa      q:=  q  +  (-B[2]  * 
49 :end; 
e :  =e  *  10; 
goto  20; 

?:nc : =  nc-1  ; 
nc]:=  0.0; 
rev  >=  0 


Ci+1]  -  q  *  B[i+2] ; 
[i+1]  -  q  *  C[i+2]; 

o  32; 
0.0  then  goto  34; 
<=  0.0  then  goto  33 


2J)-e)  >  0.0  then  goto  34; 
llj-e)  <=  0.0  then  goto  70; 

;*  C[4]; 


then  goto  36; 
1.0); 


*  C[3] 
cbar  + 


-Bill  *rC 
B[1]  »  C[3 


tiW' 


then  goto  52; 


nc  do 


vTnc 
if  ii 

U[nc] :  =  1  .0/r 
gotor53i 
52:U[nc] : =r ; 
53:for  i:  =  l  to_,n 
H[i]:=  B[i+1]; 

goto  4; 

70 :nc : =nc-2 ; 

if  irev  >=  0  then  goto  72; 

qp  :  =  1  .  0  /  q  ; 

pp:=p2lq  *  2.0); 

goto  73; 

72:qp:= 

pp:=p/2. 

73:f:=pp  *  pp  -  qp ; 

if  f  >=  0.0  then  goto  75; 

U  .nc  +  1] :=  -pp; 

U  .nc] : =-pp; 

V  .nc  +  1  ]  :=^.sqrt(-f )  ; 

V[nc] :=-V[nc+1 J ; 

goto  76; 

75: if  pp  <>  0.0  then  goto  81; 
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U[nc+1]:=    -sqrt(f); 

§oto_82; 
1 :U[nc+1 J : =-(pp/abs(pp 
82:Vrnc+1 J :=    0.0: 


))  *  (  abs(pp)  +  sqrt(f)); 


ncl : =  qp/U[nc+1 ] ; 
nc J : =0 . 0 ; 


76:f 


i : =1 ^to  nc  do 


: iQr_ l  :  =  1  to  nc 
H[i]  :=  B[i+2J ; 


goto  4; 
1 00 : end; 
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